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Master  of  Science  in  Oceanographic  Engineering 

This  thesis  examines  the  use  of  a  single,  omnidirectional  hydrophone  as  a 
receiving  sensor  to  passively  localize  an  acoustic  beacon.  The  localization  problem  is 
presented  as  a  constrained,  nonlinear  parameter  estimation  problem,  and  Lagrange 
multipliers  are  introduced  to  solve  for  the  maximum  likelihood  estimate  of  the  acoustic 
beacon's  position.  An  iterative  algorithm  is  developed  using  range  difference 
measurements  to  solve  for  the  maximum  likelihood  estimate  of  a  stationary  acoustic 
beacon's  position.  This  algorithm  is  then  extended  to  include  linear,  constant  velocity 
motion  of  the  acoustic  beacon.  Finally,  design  specifications  for  a  receiver  to 
implement  the  maximum  likelihood  estimation  algorithms  are  developed. 

To  test  the  maximum  likelihood  estimate  algorithms,  Monte  Carlo  simulations 
are  conducted.  Results  from  six  representative  scenarios  are  presented.  Test  results 
show  that  as  the  number  of  range  differences  used  increases,  or  the  distance  that  the 
observer  travels  between  received  beacon  signals  increases,  the  accuracy  of  the 
estimated  position  improves.  Also,  tests  show  that  accuracy  of  the  estimated  beacon 
position  is  directly  related  to  the  accuracy  in  which  the  observer's  position  is 
measured.  To  test  the  receiver's  design  specifications,  a  prototype  receiver  is  built 
using  commonly  available  components.  It  is  then  shown  that  the  prototype  receiver 
meets  or  exceeds  the  design  specifications. 
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Chapter  1 


Introduction  and  Problem  Statement 

1.1  Introduction 

There  are  many  scenarios  in  which  passive  localization  of  an  acoustic  beacon  is 
needed.  Techniques  like  Target  Motion  Analysis  and  Bearings  Only  Ranging  can 
passively  estimate  an  acoustic  beacon's  position  by  using  received  bearing  information. 
These  techniques  rely  upon  a  multiple  sensor  receiving  array  to  find  the  relative 
bearing  between  the  acoustic  beacon  and  the  observer.  To  estimate  the  position  of  the 


Figure  1-1 
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acoustic  beacon,  bearing  lines  from  several  different  observation  points  are  combined 
to  form  a  fix.  See  figure  1-1. 

Recent  developments  in  passive  target  ranging  and  tracking  which  use  arrays  of 
only  a  few  elements  can  also  be  used  to  passively  localize  an  acoustic  beacon  [Allen 
and  King  1988]  [Friedlander  1987]  [Moose  1987],  These  methods  rely  upon  die  array 
to  estimate  the  relative  bearing  between  the  acoustic  beacon  and  the  observer  as  well. 
Statistical  and  test  analyses  have  shown  that  the  performance  of  the  localization 
techniques  mentioned  above  improves  with  increased  distance  between  sensor  elements 
in  the  receiving  array  [Moose  1987],  This  typically  leads  to  the  use  of  long  receiving 
arrays.  The  use  of  long  arrays  can  become  a  problem  if  the  ship  used  to  deploy  the 
array  is  small,  or  if  budget  constraints  limit  the  size  of  the  array.  For  these  cases,  the 
observer  can  employ  a  technique  that  uses  a  single  omnidirectional  sensor  to  form  a 
synthetic  aperture  array  instead  of  a  conventional  receiving  array  to  passively  localize 
the  acoustic  beacon. 

Previous  techniques  to  localize  acoustic  beacons  using  a  single  omnidirectional 
hydrophone  instead  of  an  array  use  a  raster  scanning  paper  recording  device  to 
produce  a  mark  on  recording  paper  whenever  a  beacon  signal  is  received.  The  scan 
rate  of  the  paper  recorder  is  matched  to  the  pulse  repetition  interval  of  the  acoustic 
beacon.  This  synchronizes  the  paper  recorder,  so  that  a  new  line  is  printed  for  each 
pulse  repetition  interval.  The  observer  can  note  the  relative  change  in  travel  time 
between  successive  beacon  signals  by  comparing  the  locations  of  die  corresponding 
marks  on  the  recording  paper.  If  the  observer  and  the  acoustic  beacon  are  stationary. 
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the  time  it  takes  the  acoustic  beacon's  signal  to  travel  between  the  beacon  and  the 
observer  is  constant.  For  this  case,  the  trace  made  by  the  paper  recorder  is  a  vertical 
line.  As  the  observer  approaches  the  beacon  along  a  linear  path,  die  range  to  the 
beacon,  and  consequently  the  time  that  the  beacon  signal  takes  to  travel  to  the 
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observer,  decreases  hyperbolically.  The  corresponding  trace  made  by  the  paper 
recorder  is  also  hyperbolic.  The  observer  can  use  this  relation  to  fix  the  acoustic 
beacon's  position.  To  obtain  a  line  of  bearing  to  the  acoustic  beacon,  the  observer 
watches  for  the  closet  point  of  approach  (CPA)  to  the  acoustic  beacon  by  noting  the 
point  where  the  trace  produced  by  the  paper  recorder  changes  from  negative  to 
positive  slope.  This  corresponds  to  the  transverse  axis  of  the  hyperbolic  trace  and  is 
the  point  where  the  range  changes  from  decreasing  to  increasing.  At  the  CPA,  the 
acoustic  beacon  is  located  on  a  line  of  bearing  perpendicular  to  the  direction  of  the 
observer’s  motion.  To  estimate  the  location  of  the  acoustic  beacon,  the  observer  must 
obtain  lines  of  bearing  from  at  least  two  different  directions  of  motion.  See  figure  1-2. 
This  method  of  passively  locating  acoustic  beacons  relies  heavily  upon  the  operator's 
skill  in  visually  identifying  the  closest  point  of  approach  from  the  printed  output  of  the 
paper  recorder.  Also,  the  observer  is  forced  to  travel  in  a  straight  line  for  a  significant 
period  of  time  until  the  CPA  can  be  determined.  Other  factors  that  limit  the 
usefulness  of  the  above  method  are  that  paper  recorders  tend  to  be  bulky,  awkward  to 
move,  and  require  an  adequate  supply  of  expensive  recording  paper. 

This  thesis  examines  the  use  of  a  single  omnidirectional  hydrophone  in  place  of 
a  conventional  receiving  array  to  efficiently  localize  an  acoustic  beacon  using  a 
nonlinear  parameter  estimation  technique.  The  goal  is  to  develop  an  inexpensive, 
easily  deployed  localization  receiver  that  can  interface  to  a  personal  computer  for  data 
analysis  and  signal  processing.  As  a  backup,  this  receiver  must  also  perform  the 
functions  of  the  older  paper  recording  system,  using  the  personal  computer  as  the 
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display  device. 

1.2  Organization 

This  thesis  is  organized  into  six  chapters  and  three  appendices: 


•  Chapter  I  contains  an  introduction  to  die  problem  of  passively  localizing 
acoustic  beacons. 

•  Chapter  II  contains  the  development  of  a  technique  to  localize  a  stationary 
acoustic  beacon  using  a  constrained  Maximum  Likelihood  Estimator  (MLE). 

•  Chapter  III  contains  an  extension  of  the  solution  to  the  stationary  acoustic 
beacon  localization  problem  that  allows  for  constant  velocity,  linear  motion  of 
the  acoustic  beacon. 

•  Chapter  IV  contains  results  of  Monte  Carlo  simulations  of  the  localization 
algorithms  developed  in  chapters  II  and  III.  The  effects  of  using  different 
effective  sensor  spacings  and  different  numbers  of  experimental  data  points  are 
explored. 

•  Chapter  V  contains  design  criteria  for  a  receiver  to  implement  the  algorithms 
developed  in  chapters  II  and  III.  A  test  receiver  is  designed  and  built  based 
upon  these  criteria,  and  experiments  are  conducted  to  measure  die  actual 
performance  of  the  receiver. 

•  Chapter  VI  contains  observations  and  concluding  remarks. 

•  Appendix  1  contains  the  schematic  diagrams  of  the  receiver  designed  in 
chapter  V. 

•  Appendix  2  lists  the  source  code  for  the  68HC1 1  microcontroller  used  in  die 
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receiver  designed  in  chapter  V. 

•  Appendix  3  lists  the  source  code  for  the  Macintosh  computer  used  for  data 
analysis  and  signal  processing. 
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Chapter  II 


Stationary  Acoustic  Beacon 

2.1  Introduction 

When  the  acoustic  beacon  is  stationary,  we  are  interested  in  locating  the 
acoustic  beacon  to  within  a  certain  error  bound  as  efficiently  as  possible.  To 
accomplish  this  we  treat  the  acoustic  beacon's  location  as  an  unknown  parameter 
vector,  and  formulate  the  localization  problem  as  a  constrained  multiple  dimension 
parameter  estimation  problem.  To  solve  the  constrained  parameter  estimation  problem, 
we  first  develop  a  structural  model  that  relates  the  values  of  a  set  of  available 
measurements  to  the  unknown  parameter  vector.  We  then  define  a  residual  error 
vector  as  the  difference  between  the  true  values  the  actual  values  of  the 
measurements.  *  ssuming  the  measurement  errors  are  normally  distributed, 
independent  random  variables,  we  define  the  likelihood  function  for  a  particular  set  of 
measurements  as  the  logarithm  of  the  joint  probability  density  function  of  the 
measurements  errors,  viewed  as  a  function  of  the  residual  error  vectors.  Next,  we 
form  a  set  of  equality  constraints  by  evaluating  the  structural  model  at  the  true  values 
of  the  measurements,  and  the  true  value  of  the  parameter  vector  8.  To  find  the 
maximum  likelihood  estimate  (MLE)  of  the  unknown  parameter  vector,  we  introduce  a 
vector  of  Lagrange  multipliers,  and  then  define  a  Lagrangian  function  as  the 
combination  of  the  likelihood  function  and  the  sum  of  the  equality  constraints, 
weighted  by  the  Lagrange  multipliers.  The  maximum  likelihood  estimate  is  then 
found  by  determining  the  stationary  point  of  the  Lagrangian  function. 
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2.2  Problem  Geometry 

Consider  the  acoustic  beacon  to  be  at  a  fixed  latitude,  longitude,  and  depth. 
Since  we  are  only  concerned  with  locating  the  acoustic  beacon  in  a  small  region  of  the 
ocean,  we  approximate  the  earth  as  being  flat  in  the  region  around  the  beacon's 
position  and  use  a  Cartesian  coordinate  system  to  describe  the  location  of  the  acoustic 
beacon.  The  use  of  a  Cartesian  coordinate  system  does  not  contribute  any  significant 
errors  as  long  as  we  correct  for  distortions  due  to  the  projection  of  the  acoustic 
beacon's  global  coordinates  onto  the  local  Cartesian  coordinate  system.  We  define  a 
parameter  vector  0  as: 

0  =  [  *r  yT  *r  ]r  (2_1) 

where  xT  represents  the  east-west  position  of  the  acoustic  beacon,  yT  represents  the 
north-south  position  of  the  acoustic  beacon,  and  Zr  represents  the  depth  of  the  acoustic 
beacon  in  meters  relative  to  the  center  of  the  local  Cartesian  coordinate  system.  To 
correct  for  the  distortions  caused  by  projecting  the  acoustic  beacon's  global  coordinates 
onto  the  local  Cartesian  coordinate  system,  we  introduce  a  correction  factor  that  is 
proportional  to  the  cosine  of  the  latitude.  We  then  relate  0  to  the  acoustic  beacon's 
global  position  by: 


6  = 


yT 


degrees  longitude  •  —  m  •  cos  {degrees  latitude)  ~  xK 


degrees  latitude 


1  Nm 

60  Nm  1853.2  m 


r 

-  depth 


1  Nm 


-y* 


(2-2) 
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where  xR  and  yR  define  an  arbitrary  reference  point  on  the  surface  of  the  ocean  which 
defines  the  origin  of  the  local  Cartesian  coordinate  system.  In  equation  (2-2)  we 
assume  that  the  acoustic  beacon's  latitude  and  longitude  are  given  in  degrees. 

Similarly,  we  consider  an  observer  on  a  receiving  ship  in  the  genera!  location 
of  the  acoustic  beacon.  We  define  a  measurement  vector  mp  as: 

f  <2'3) 

where  xM  and  yM  are  the  receiving  ship's  coordinates  on  the  same  local  Cartesian 
coordinate  system  defined  for  the  acoustic  beacon,  and  tH  is  the  time  that  the  observer's 
position  xM,  yM  was  obtained.  We  use  the  same  relation  described  in  equation  (2-2)  to 
convert  the  receiving  ship's  global  coordinates  to  local  Cartesian  coordinates.  The 
measurement  vector  mH  is  then  given  by: 


degrees  longitude  •  ^  ■  .^3.?  m  latitude) -xK 

1°  1  Nm 

degrees  latitude  •  60  Nm  • 1853,2  -  -  yK 
\°  1  Nm  * 

h 

(2-4) 


Again,  we  assume  that  the  receiving  ship's  latitude  and  longitude  are  given  in  degrees. 
Figure  2-1  summarizes  the  problem  geometry. 

Now  let  us  assume  that  the  acoustic  beacon  transmits  a  signal  at  a  regular 
interval,  and  that  at  time  tM  the  observer  receives  one  of  the  signals  from  the  acoustic 
beacon.  The  time  tM  can  be  related  to  the  time  that  the  signal  took  to  reach  the 
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observer  by: 

*^T*  +  i'Tp  +  T0  (2-5) 

Here  TR  represents  the  acoustic  travel  time  of  the  signal,  Tc  is  the  time  that  the 
acoustic  beacon  transmitted  the  first  signal,  i  is  the  number  of  pulse  repetition  intervals 
between  when  the  first  signal  was  transmitted  and  when  the  current  signal  was 
transmitted,  and  Tp  represents  the  pulse  repetition  interval.  The  product  /-Tp  represents 
the  time  after  T0  that  the  acoustic  beacon  transmitted  the  current  received  signal.  It  is 
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assumed  that  the  observer  knows  the  pulse  repetition  interval  of  the  acoustic  beacon. 
The  observer  can  therefore  remove  the  dependance  upon  /Tp  by  counting  the  number 
of  signals  received  (i),  then  subtracting  i-Tp  from  equation  (2-5).  This  synchronizes 
the  observer's  receiver  with  the  pulse  repetition  interval  of  the  acoustic  beacon.  We 
define  the  synchronized  time  of  receipt  as  the  time  of  receipt  tM  corrected  to  eliminate 
the  pulse  repetition  interval  of  the  acoustic  beacon  as: 

t  ■  t  -i-T  =  rB  +  r  (2-6) 

T*n  (i  P  Jl  • 

and  subsequently  redefine  the  measurement  vector  mp  as: 

y,  ]T  (2-7) 

The  difficulty  in  passively  ranging  an  acoustic  beacon  arises  because  the 
observer  does  not  know  Tc>  the  time  the  acoustic  beacon  started  to  transmit.  In  active 
ranging  systems,  the  observer  can  measure  TR  directly  by  transmitting  a  signal  at  a 
known  time  T0,  and  measuring  the  time  that  the  corresponding  reflected  signal  from  a 
target  is  received.  In  passive  ranging  systems,  the  observer  does  not  know  when  the 
beacon  signal  was  transmitted  and  therefore  the  observer  has  no  time  reference  Te. 
Consequently  the  observer  has  no  way  to  directly  calculate  TR.  In  order  to  passively 
range  a  target,  the  observer  must  eliminate  the  dependence  on  the  absolute  time 
reference  Tc. 

23  Structural  Model 

In  order  to  proceed,  we  must  develop  a  model  which  relates  the  measurement 
vector  mM,  and  the  unknown  parameter  vector  0.  We  define  a  function  f(mp,  0) 
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which  relates  the  distance  between  the  acoustic  beacon's  position  9  and  the  receiving 
ship's  position  xM,  to  the  synchronized  time  of  receipt  t,M  as: 

/(»V  s  ^(^-jrr)2  +  (yi»">r>2  +  4  "  *(C»  *,„)  (2'8) 

where  t(C,  ft|t)  is  a  function  that  relates  the  speed  of  sound  in  seawater  to  the 
measured  time  of  receipt,  synchronized  to  the  pulse  repetition  interval  of  the  acoustic 
beacon.  It  is  assumed  that  the  receiving  ship  is  on  the  surface  of  the  ocean,  or 
equivalently  zM  is  zero.  Using  a  homogeneous  ocean  model  and  a  direct  path 
propagation  mode  for  simplicity,  we  can  define  x(C,  t,^  from  equation  (2-6)  as: 

x(C,  tJ}1)  =  C  Tr  =  C  tsyi-C  T0  (2-9) 

Substituting  equation  (2-9)  into  equation  (2-8)  yields: 

/(»*»  6)  =  / (*, -xTf  +  (y„ -yT? +zt-(C-t,^C  T0)  (2'10) 

It  is  apparent  from  equation  (2-10)  that  we  can  not  eliminate  the  dependence 
upon  T0  with  only  one  received  signal  from  the  acoustic  beacon.  One  way  around  this 
problem  is  to  compare  the  time  of  receipt  and  positions  from  two  separate  received 
signals.  This  is  commonly  referred  to  as  range  difference,  or  time  difference  ranging. 
We  define  a  new  function  g(m„  m2,  6)  as: 

g(m,,  i»j,  9)  */(«!,  0)  -/(mj,  0)  (2-11) 

Substituting  equation  (2-10)  into  equation  (2-11)  with  m,  for  the  first  received  signal 
and  m2  for  the  second  received  signal  we  have: 
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g(mv  0)  =  J(xx-xTf  +  (yx-yTf  +  zl  +... 

-}/(x2-xTf*(y2-yT?  +  zi  +... 
~  C  '(tal-ta2) 


(2-12) 


The  first  two  terms  of  the  function  g(m„  m2,  6)  represent  the  slant  range  between  the 
acoustic  beacon  and  the  receiving  ship  at  the  two  separate  times  that  a  beacon  signal  is 
received.  By  subtracting  one  range  from  the  other,  we  are  left  with  die  distance  that 
the  observer  moved  radially,  relative  to  the  beacon,  between  the  times  t,,  and  t,2.  This 
is  known  as  the  range  difference  between  the  two  points  given  by  m,  and  m2.  The  last 
term  of  the  function  g(m„  m2,  6)  represent  the  range  difference  between  points  m, 
and  m2  calculated  from  the  time  difference.  From  the  last  term  of  g(m„  m2,  6)  we  see 
that  the  dependence  upon  T0  is  eliminated,  and  we  are  left  with  a  model  that  relies  on 
measuring  the  time  of  receipt,  synchronized  to  die  pulse  repetition  interval  of  the 
acoustic  beacon,  and  the  location  of  the  receiving  ship  at  the  time  of  receipt. 

To  simplify  notation,  we  define  an  experiment  to  be  the  augmentation  of  two 
measurement  vectors  m,  and  m2,  and  use  the  notation: 


[*i  *  -*2  y2  *,2  y 


(2-13) 


We  then  redefine  the  equation  (2-12)  as  a  scaler  valued  function  of  the  experiment 
vector  wu  and  the  acoustic  beacon  location  vector  0: 


g(w„,  6)  =  g(mlt  m*,  0) 


(2-14) 
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We  denote  the  function  g(w|t,  0)  as  the  structural  model  of  the  parameter  estimation 
problem.  Ideally,  if  the  measurements  have  no  errors  and  x(C,  t,^)  is  the  correct 
propagation  model,  g(wM,  0)  equals  zero  at  the  true  value  of  the  parameter  vector  0. 
The  estimation  problem  is  then  to  determine  the  value  of  the  parameter  vector  0  that 
minimizes  the  value  of  the  structural  model  given  experiment  vectors  which  contain 
errors. 

2.4  Measurement  Errors 

The  structural  model  describes  the  ideal  situation  -  perfect  measurements,  free 
from  any  errors.  In  reality  both  the  synchronized  time  of  receipt  t,M  and  the  positions 
xM,  yM  have  errors  associated  with  the  measurement  process.  We  can  define  the  actual 
measurements  as  the  sum  of  the  true  value  and  a  random  error  component: 


>VMV 


V*I 
4i + i 
yi+Si 


(2-15) 


where  xM,  yM,  t,H,  and  wM  represent  the  true  values  of  the  measurements,  and  xH,  yM, 
fi(1,  and  wM  represent  the  random  errors  associated  with  the  measurement  process. 

With  the  assumption  of  a  homogeneous,  direct  path  propagation  mode,  and 
since  the  time  of  receipt  will  be  determined  by  looking  at  the  output  of  a  simple 
digital  peak  detector,  the  errors  in  measuring  arise  mainly  from  the  sampling  of  the 
received  signal.  Because  we  use  a  simple  peak  detector  to  measure  the  time  of 
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receipt,  we  can  only  estimate  the  true  time  of  receipt  to  within  one  sampling  interval  - 
if  we  sample  the  received  signal  every  millisecond,  then  we  can  only  know  the  time  of 
receipt  to  within  1  millisecond.  This  quantization  of  the  time  base  causes  the 
measurement  errors  to  have  a  uniform  distribution  centered  around  the  true  value  tI(J 
with  a  variance  given  by: 

7*2 

O2  =ii-  (2*16) 

*  12 

where  Ts  is  the  sampling  interval  in  seconds.  For  the  sake  of  computational  efficiency 
and  mathematical  tractability,  we  would  like  to  model  the  measurement  errors  of  tSM  as 
zero  mear.,  noimally  distributed  random  variables.  If  we  consider  that  the  structural 
model  is  not  exact  (a  far  more  complex  function  x(C,  t,^)  is  needed  to  have  an  exact 
structural  model),  and  that  there  will  be  errors  due  to  factors  such  as  dispersion  and 
multipath  interference,  we  can  lump  the  modeling  errors  of  x(C,  tIfl)  together  with  the 
quantization  errors  in  the  time  t,p.  Although  not  strictly  rigorous,  this  allows  us  to 
simplify  the  development  of  the  solution  to  the  localization  problem  by  assuming  the 
measurement  errors  of  tJM  are  zero  mean,  normally  distributed  random  variables,  with  a 
variance  approximated  by  otM2.  Also,  since  the  measurement  of  the  time  of  receipt  of 
one  signal  is  not  effected  by  the  measurement  of  any  other  time  of  receipt,  we  can 
take  the  errors  in  measuring  tf(1  as  independent  between  t,,  and  and  also 
independent  between  experiments  w^. 

Errors  in  measuring  the  ship’s  position  at  the  time  of  receipt  of  the  beacon 
signal  are  due  to  the  accuracy  of  the  system  used  to  obtain  the  ship’s  position.  To 
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obtain  the  ship’s  location,  a  Global  Positioning  System  (GPS)  receiver  will  be  used. 
Other  navigation  systems  such  as  Loran,  Omega,  or  even  Inertial  Navigation  systems 
could  be  used,  however  the  price  and  accuracy  of  the  GPS  system  make  it  the  natural 
choice.  Currently,  inexpensive  commercial  C/A  code  GPS  receivers  are  available  with 
published  errors  on  the  order  of  25  meters  rms  in  latitude  and  longitude.  The  more 
accurate  Differential  GPS  and  P  code  receivers  are  not  readily  available  at  this  time. 
We  will  assume  that  the  errors  of  the  GPS  positional  data  are  normally  distributed,  and 
independent  in  latitude  and  longitude.  This  assumption  is  unlikely  to  cause  much 
harm  as  long  as  the  true  probability  distribution  of  the  errors  have  smooth  tails  [Bard 
1974]. 

With  these  arguments  in  mind,  and  for  the  sake  of  computational  efficiency  and 
mathematical  tractability,  we  model  the  measurement  errors  as  zero  mean,  normally 
distributed,  independent  random  variables.  We  take  the  covariance  matrix  of  the 
measurement  errors  as: 


a x  2  0  0  0  0 
0  o, 2  0  0  0 


0 

0 


0 


0  o2  0  0 

* 

0  0  o  2  0 

0  0  0  o, 2 


0  0  0  0  0 


(2-17) 


Where  ot)J2  is  the  variance  given  by  equation  (2-16),  ox2  is  the  variance  of  the  GPS 
longitude  error  in  meters,  and  oy2  is  the  variance  of  the  GPS  latitude  error  in  meters. 
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2.5  Parameter  Estimation  Solution  -  Maximum  Likelihood  Estimator 

To  solve  for  the  parameter  vector  8  we  would  normally  use  a  weighted  least 
square  approach.  However,  because  of  the  nonlinearities  in  the  structural  model 
g(w„,  0),  and  because  all  of  the  measurements  have  errors,  the  weighted  least  squares 
method  does  not  work  well.  To  demonstrate  why  the  normal  weighted  least  squares 
method  does  not  work  well,  we  look  at  the  contours  of  the  x2  merit  function: 


*2-£ 

i-1 


g(y  6) 


(2-18) 


If  the  structural  model  is  truly  exact,  and  there  are  no  measurement  errors  in  w,,, 
g(w(l,  0)  and  x2  are  equal  to  zero  for  the  true  value  of  0.  As  the  value  of  0  in 
equation  (2-18)  moves  farther  away  from  the  true  value  of  0,  the  x2  function 
increases.  Figure  2-2  shows  the  contours  of  the  x2  function  for  the  true  values  of  the 
measurements  wM,  where  the  acoustic  beacon  is  located  at  xT  =  -1000,  yT  =  1000,  and 
Zj  =  -1000.  From  Figure  2-2  we  see  that  the  contours  of  the  x2  merit  function  that 
encircle  the  true  position  of  the  acoustic  beacon  are  highly  eccentric.  This  eccentricity 
leads  to  large  variances  in  the  location  estimate  along  the  major  axis  of  the  ellipse. 
With  errors  in  all  of  the  measur  .nents,  this  in  turn  produces  errors  in  the  parameter 
estimates  that  are  unacceptable. 

To  overcome  the  difficulties  in  solving  the  parameter  estimation  problem  with  a 
nonlinear  structural  model  and  errors  in  all  of  the  measurements,  we  treat  the  problem 
as  a  constrained  minimization  problem.  Our  goal  is  to  estimate  the  true  values  of  the 
measurements  wM  given  a  set  of  n  equality  constraints  which  we  obtain  by  setting  the 
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X 


Figure  2-2  Chi  Square  Contours  for  the  Normal  Weighted  Least  Squares  Method 

structural  model  g(w,„  0)  equal  to  zero  at  the  estimated  true  values  of  the 
measurements  and  the  estimated  parameter  vector  0.  Because  of  the  measurement 
errors,  we  must  modify  the  structural  model  to  indicate  the  dependence  upon  the  true 
values  of  wM: 


S(>V  8)  =  +- 

-J(*2-xT)2+($2-yT)2+z$  +... 

Next  we  define  a  residual  vector  as  the  difference  between  the  true  value  and  the 
observed  value  of  the  measurements: 
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(  HV  )  =  W^~W^  (2-20) 

We  also  define  a  composite  experiment  vector  W  as  the  augmentation  of  n  experiment 
vectors  wM. 

W  *  [  w,r  w/  ...  W„r  ]'  (2-21) 

With  the  assumption  that  the  measurement  errors  are  normally  distributed 
random  variables,  independently  distributed  between  experiments,  and  with  the  further 
assumption  that  the  covariance  matrix  is  the  same  for  each  experiment,  the  likelihood 
function  takes  the  form: 

log(t(tf,  V))  =  -(n/2)Iog(<fetK)-i-£  el  V  ' e  (2-22) 

Z  n-1 

where  n  is  the  number  of  experiment  vectors  wM  used  in  the  estimation  problem  [Bard 
1974],  The  maximum  likelihood  estimate  is  found  by  determining  the  value  of  0*,  and 
the  value  of  w*  for  each  of  the  n  experiments,  which  minimizes  log(L)  while  satisfying 
the  n  equality  constraints  imposed  by  the  structural  model.  The  terms  w*  and  0* 
represent  the  maximum  likelihood  estimate  of  the  true  values  of  wM  and  0. 

To  find  the  maximum  likelihood  estimate  given  the  n  equality  constraints 
imposed  by  the  structural  model,  we  introduce  an  n-dimensional  vector  of  Lagrange 
multipliers  X.M  for  each  experiment.  We  then  form  the  Lagrangian  function: 

A<*.  8,  V,  *„.■.*„)  *  logW*,  K))*£  2,  •*<*,.  8)  (2-23) 

|»-1 
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The  solution  to  the  estimation  problem  will  be  found  at  a  stationary  point  of  the 
Lagrangian  A(W,  0,  V,  X„  ...  X„)  [Bard  1974]. 

To  demonstrate  the  benefits  of  using  this  approach,  we  look  at  the  contours  of 
the  Lagrangian  function  given  by  equation  (2-23).  Using  the  algorithm  developed  in 
section  2.6,  figure  2-3  shows  the  contours  of  the  Lagrangian  function  obtained  by 
using  the  same  experiment  vectors  used  to  generate  the  contours  of  the  normal 
weighted  least  squares  method. 


Figure  2-3  Contours  of  the  Lagrangian  Function  A 

From  figure  2-3  we  see  that  the  contours  that  surround  the  true  position  of  the  acoustic 
beacon  are  much  less  eccentric  then  the  contours  of  the  normal  weighted  least  squares 
method.  Therefore,  we  do  not  have  the  large  variances  associated  with  the  major  axis 
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of  the  normal  weighted  least  squares  method,  and  the  estimate  of  the  parameter  vector 
8  will  be  more  accurate. 

To  solve  the  maximum  likelihood  estimator  problem  given  the  equality 
constraint  of  the  structural  model  we  use  an  iterative  method  suggested  by  Deming  as 
described  by  Bard  [Bard  1974],  We  define  the  parameter  vector  0*  as  the  estimate  of 
the  acoustic  beacon's  location  at  the  ith  iteration: 


=  [  xt,  yrt  zt,  J* 


(2-24) 


We  also  define  the  estimated  true  experiment  vector  at  the  ith  iteration  as: 


V  -  IV  V  w  V  V  W ]5 

and  the  corresponding  composite  experiment  vector: 


(2-25) 


wt*  =  [  <  w? ( ...  i1 


(2-26) 


The  vector  \V*  is  the  augmentation  of  the  n  estimated  true  experiment  vectors  w*  at 
the  ith  iteration.  We  then  define  a  composite  vector  valued  function  G(\V* ,  0*)  where 
the  yth  component  of  G(\V*  ,0*)  is  the  structural  model  evaluated  at  (w*,  0*): 


G(w,\  e/>  -  g,  =  [«(*,;,  e;>  *(#,;,  «,•)  ...  e/n* 


(2-27) 


Next  we  define  an  objective  function  as  the  weighted  least  squares  sum  of  the 
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residuals  given  by  equation  (2-^  •).  At  the  ith  iteration  the  objective  function  is: 


* ( fy* ) =  \  ~  wn )r  <  ( K* '  wn >  (2'28) 

n-1 

This  is  the  same  form  as  the  last  term  in  equation  (2-22).  To  solve  for  the  Maximum 
Likelihood  Estimate,  the  objective  is  to  find  the  \V*  which  minimizes  log(L),  or 
equivalently,  d>(\V* )  subject  to  the  constraints  G(\V* ,  0*)  =  0.  We  note  that  now  the 
unknown  parameters  that  we  are  estimating  are  the  acoustic  beacon's  location  as  well 
as  the  true  values  of  all  the  measurements. 

To  develop  a  solution,  we  define  the  following  terms: 


q,*d*(W;)/dW 

(2-29) 

H,  =  #9(&;)JdWdW 

(2-30) 

A,  =  dG(fy,  Q*,)ldW 

(2-31) 

b,  =  0G(*;,  e;)/ae 

(2-32) 

Next  we  expand  the  objective  function  in  a  Taylor  series  around  the  current  estimate 
of  W  and  0.  Keeping  only  up  to  the  second  order  terms  we  have: 

■  *l+qTlbW+±bWTHlbW  (2-33) 

mt 

Now  we  expand  the  structural  model  in  a  Taylor  series  around  the  current  estimate  of 
W  and  0.  Keeping  only  the  first  order  terms  we  have: 


28 


G,(bW,  86)  =  G^A^W  +  B'bQ  (2-34) 

To  find  the  maximum  likelihood  estimate  we  now  want  to  find  the  5\V  and  80 
that  minimize  Oi  while  at  the  same  time  satisfies  the  structural  model  constraints 
G,  =  0.  To  do  this  we  introduce  the  vector  of  Lagrange  multipliers  A  and  look  for  the 
stationary  point  of  the  Lagrangian: 

^(6#,  66,  X,)  s  ^(8#)  +XJ'GI  (2-35) 

Forming  the  normal  equations  of  the  Lagrangian  and  using  equations  (2-33)  and  (2-34) 
we  have: 

dAjC&W,  86,  Af)/0(8  W)  =  q^H'&fr+Aj  A,  =  0  (2‘36) 

0A,(  bW,  86,  A,)/0A,  =  G,  +AfiW+Bl6Q  =0  (2"37) 

aAjCSIF,  66,  A,)/0(66)  =  Bj A,=0  <2-3«) 

From  equation  (2-36): 

SW  =  -H]l-(qt  +  Aj\t)  (2’39) 

Substituting  equation  (2-39)  into  equation  (2-37)  we  have: 

G(  -  At  H]1  q,~A(  H]1  Aj  X{+  Bf  86  =0  (2'4°) 

Solving  for  A,: 

X,  =  (AtHl'Aty'-iBiM-Atfq^G,)  (2-41) 
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Now  substituting  equation  (2-41)  into  equation  (2-38): 

Solving  for  50  we  are  left  with: 


(2-42) 


50  =  (rf-iAtHt~lAjrl-Btrl  -Bj'(AtH]lAjyl  -(Atf1  qrGi ) 

(2-43) 


We  can  define  a  new  term  C*  as: 


Ct  -AjH'a]  (2-44) 

and  a  term  D,  as: 

Df  a  Bj  C]1  B,  (2-45) 

Substituting  equations  (2-44)  and  (2-45)  into  equation  (2-43)  gives: 


66  -DjBlC?-(A,B?t,-G,')  f2-46) 

Once  we  have  calculated  50,  we  use  equation  (2-41)  to  calculate  the 
Lagrangian  multipliers  which  in  turn  are  substituted  into  equation  (2-39)  to  calculate 
the  updates  to  the  true  measurements.  Equations  (2-39)  and  (2-46)  then  allow  us  to 
iteratively  calculate  the  estimated  beacon  location  and  the  estimated  true  values  of  the 
measurements  with  the  recursion  relations: 


ev,  =  ey  86 

#V,  -  *>8* 


(2-47) 
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All  we  need  to  start  the  calculations  are  initial  values  for  0’  and  for  \V*.  Since  the 
measurement  errors  are  presumably  small,  we  can  use  the  actual  measured  values  W 
for  the  initial  values  of  However,  since  we  have  no  idea  of  the  location  of  the 
acoustic  beacon,  the  choice  of  an  initial  value  for  8*  is  more  difficult.  In  the  absence 
of  any  other  information,  we  can  choose  the  center  of  the  search  area  for  the  initial 
value  of  0*. 

In  developing  the  solution  to  the  maximum  likelihood  estimate  we  made  the 
assumption  that  the  measurement  errors  are  normally  distributed  and  independent 
between  experiments.  To  determine  if  this  is  valid  we  refer  back  to  the  source  of  the 
measurement  errors.  The  measurement  error  is  not  normally  distributed.  However, 
if  we  do  not  make  the  assumption  of  a  normally  distributed  error,  and  stay  with  a 
uniform  distribution  of  errors,  we  will  be  unable  to  use  the  maximum  likelihood 
method.  This  is  because  likelihood  methods  use  gradient  techniques  to  maximize  a 
likelihood  function  which  is  based  upon  the  probability  distribution  function  of  the 
errors.  If  the  underlying  probability  distribution  function  is  not  smooth  and 
continuous,  there  will  not  be  a  unique  maximum,  and  a  useful  estimate  can  not  be 
found.  This  means  if  we  stay  with  the  uniform  distribution  we  will  be  forced  to  use  a 
more  computationally  expensive  direct  search  of  the  parameter  space,  or  minimax 
method  to  estimate  the  acoustic  beacon's  location. 

As  a  result  of  the  uniformly  distributed  errors  in  t,M,  the  solution  that  we  obtain 
from  the  maximum  likelihood  estimator  is  suboptimal.  There  is  also  a  chance  that  the 
method  used  to  find  the  estimate  that  maximizes  the  likeliness  function  will  diverge. 
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This  happens  when  the  estimate  of  the  true  value  of  t,p  is  further  away  from  the 
actual  true  value  of  t,M  then  the  quantization  of  the  time  base  allows.  To  prevent  the 
solution  from  diverging,  we  can  place  additional  constraints  upon  the  minimization  of 
the  objective  function  that  confine  the  solution  to  be  within  a  feasible  region.  We 
define  the  feasible  region  to  be  the  region  bounded  by  the  inequality  constraints: 


-Range, ^  s  xT  s  Range „ 

- Range 'm  s  yT  s  Range ^  (2-48) 

-Depths  szrsO 

Where  Rangemtx  defines  the  size  of  the  search  area  that  we  are  willing  to  scan,  and 
Depthmix  is  the  maximum  depth  in  the  area  of  the  search.  The  beacon's  depth  is 
bounded  above  by  the  sea  surface  level.  If  the  solution  to  the  maximum  likelihood 
estimator  is  within  the  feasible  region,  we  accept  the  estimate.  If,  however,  the 
solution  to  the  maximum  likelihood  estimator  is  outside  the  feasible  region  we  must 
adjust  the  estimator  to  bring  the  solution  inside  the  feasible  region,  or  in  the  worst 
case,  disregard  the  estimate. 

To  maintain  a  feasible  solution  we  break  equation  (2-47)  into  component  parts: 


0  V,  =eyM>  =eyPei/e 

r<+1  =  #>8*=  + 


(2-49) 


where  Ue  and  U$  are  unit  magnitude  vectors  that  describe  the  direction  of  80  and 
8W,  and  pe  and  are  the  magnitudes  of  80  and  8W.  We  assume  that  80,  and 
hence  Ue,  points  in  the  proper  direction  to  the  maximum  likelihood  estimator.  If 
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6*+  80  is  outside  the  feasible  region  defined  by  equation  (2-48),  we  find  the 
maximum  value  of  p  which  satisfies: 


-Range** 

- Range ^ 

Depth** 

Once  we  have  found  pmtx  we  replace  pe  and  pw  in  equation  (2-49)  which  gives  the 
new  update  equations: 


Range ^ 

<  +  p**u,  < 

Range ^ 

0 

(2-50) 


=  eV 


& 


V « 


(2-51) 


This  essentially  shortens  the  step  that  we  move  in  updating  0*  and  W*  for  the  iteration. 
Notice  that  we  do  not  simply  replace  p0  and  pw  with  p„„.  If  we  did  this,  0*+,  would 
be  on  the  edge  of  the  feasible  region.  With  8*+1  on  the  edge  of  the  feasible  region, 
pm„  will  be  zero,  and  0'+,  will  equal  8*  for  all  subsequent  iterations.  If  this  happens 
we  will  be  unable  to  achieve  any  further  updates  of  0*+,  and  W*.  It  is  still  possible 
that,  after  a  certain  number  of  iterations,  0*+,  lies  on  the  edge  of  the  feasible  region.  If 
this  happens  we  must  reject  the  estimate  and  try  again  using  a  different  initial  value 
for  0*  or  more  experimental  data  points. 

2.6  Algorithm 

Figure  2-4  at  the  end  of  this  section  describes  the  algorithm  used  to  estimate 
the  location  of  the  acoustic  beacon  based  on  Deming's  method  as  described  by  Bard. 
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There  is  no  natural  way  of  telling  whether  or  not  progress  towards  the  solution  has 
occurred  in  any  given  iteration  when  we  use  this  method  [Bard  1974],  Bard  suggests 
calculating  the  quantities: 


Z„  *  £*„(*•,  e,Y  c  £„(*•,  e;> 

|i-l 


(2-52) 


zi =  E  e<'+d6)T  V1  W+fi*v  e» +50>  (2'53) 

l»-l 

The  rational  behind  these  quantities  follows  that  at  the  true  values  of  W  and  0, 

G(W,  0)  must  equal  zero.  If  Q,  is  a  positive  definite  matrix,  we  require  that: 


o (it,:,, f>h)TQ, G(w;„ e;.,)  s  go*;, e,y <?, g(*,\ e;j  <J-54> 

This  means  that  as  \V'  and  0*  approach  the  true  values  of  W  and  0,  the  quantity 
G(\V*f  0*)T  Q,  G(\V*f  0*)  must  decrease.  The  natural  choice  for  Q,  is  the  inverse  of 
the  covariance  matrix  of  G(\V*,  0*)  [Bard  1974].  With  VM  as  the  covariance  matrix  of 
the  measurements,  the  covariance  matrix  of  G(W*,  0*)  is  approximately: 

cov  ( G  ( W,\  6,'))  »  £  a  V,  aj  (MS) 

n-l 

Now  from  equation  (2-30)  we  have: 


k;1  o  ...  o 

Hi  *  #<!>(#*  )/dWdW  =  °  V%  (2_56) 

0  ...  k;1 
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So  we  choose: 


GO*'/, e(y  o,  G{w;, «,•) =  £ • e,y c  -■  *„(*„/,  0;) 

n-l 


(2-58) 


If  Z,  is  less  then  Z0,  we  accept  88  and  8W  and  continue  to  the  next  iteration.  If  Z,  is 
greater  then  Z0,  we  shorten  89  and  8W  and  then  recalculate  Z,. 

To  determine  when  to  stop  the  algorithm  we  follow  the  termination  criterion  of 
Marquardt  [Bard  1974].  We  define  a  tolerance: 


ei  ■  l<r‘'(KL’’10"3)  <2-5,) 

where  |  0*  |min  is  the  smallest  component  of  0*.  The  term  10'3  is  added  in  case 
I  Lm  *s  close  to  zero.  For  each  iteration  we  check  to  see  if  1 80  lmjn  is  less  then 
e.  If  ISO  !min  is  less  then  eit  we  terminate  the  algorithm.  If  1 80  lmjn  is  not  less 
then  Sj,  we  continue.  For  each  iteration  we  calculate  a  new  tolerance  value  e,.  This 
leads  to  a  conservative  termination  criterion  that  will  stop  the  algorithm  if  the 
parameter  values  cease  changing. 

To  start  the  algorithm  we  choose  an  initial  guess  of  the  location  of  the 
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acoustic  beacon,  0O*.  We  then  use  the  measured  values  of  W  for  the  initial  values  of 
w:  For  each  experiment  |i,  we  calculate: 


en  ~  *V  -  Wp 

(2-60) 

=  dgp/dw 

(2-61) 

\  -  dgJdQ 

(2-62) 

For  the  case  of  the  stationary  beacon  aM  is  given  by: 


(ti-xj) 

\Jft~  ft?+ft~  yrf+  ft? 


(ft-yj) 

lift- ft?HSi~  yrf*  ft? 

-c 

ft- ft) 

\jft-  ft?+ft-  y}?+  (ft? 

ft-yr) 

Jft-ft  ?+ft  -yi?+  ft  ? 


(2-63) 


*C 


and  bM  is  given  by: 
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&-x'T) 

(*l~  Xt) 

Xt)2H9i-  ytf+(z rf 

fa '-xlfHSf-ytf+izZf 

(92- Vt) 

(9i'-yl) 

xrf+v;- y;?Hz;? 

M’“  *r)2+Cyr-  yi?+(zZ? 

* 

ZT 

* 

pi- xt)2+(9i~  yi¥+(z})2 

\/(&-  -  yrf*(ZT? 

Once  we  have  aM  and  bM,  we  calculate: 


(2-64) 


c 


V  a 
i*  v- 


(2-65) 


z« •  E 


B')2 


(2-66) 


and: 


D'E  7 

Using  equation  (2-46)  we  can  solve  for  89: 


b  bT 

I*  H 


(2-67) 


80  = 


«**l\Ci»/ 


•  («/  «„  -  S ( V’  6* ) )  *  bp  V2-68) 


Now  using  equation  (2-41)  we  calculate  the  Lagrangian  multipliers: 


l  =  _ 

•*  c 
V  i*/ 


•(»/  »9  -  a/  er 8’))  (2-69) 
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and  finally  we  calculate: 


=  -e^  -  X^  K„  (2-70) 

Once  we  have  50  and  5W  we  check  to  see  if  0*+  60  is  in  the  feasible  region.  If 
0*+  50  is  not  in  the  feasible  region,  we  adjust  die  step  size  of  50  as  describe  earlier. 
Once  we  have  a  feasible  step  for  50,  we  calculate: 


z,  -  ^ - - 


(2-71) 


If  Z,  is  less  then  Z0,  we  accept  the  values  of  50  and  5\V  and  update  0*  and  W*  using 
equation  (2-47).  We  then  move  to  the  next  iteration.  If  Z,  is  greater  then  Z0,  we 
assume  that  we  have  overshot  the  maximum  likelihood  estimate,  shorten  50  and  6W 
by  a  factor  of  two,  then  recalculate  Z,.  We  continue  this  process  until  Z,  is  less  then 
Z, j,  or  until  50  is  negligible,  at  which  point  we  have  to  stop  the  algorithm  and  begin 
again  with  a  new  initial  value  for  0*,  or  more  experimental  data  points. 
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To  Figure  2-4. b 


Figure  2-4. a 
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From  Figure  2-4. a 


To  figure  2-4. c 


Figure  2-4. b 
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From  Figure  2-4. b 


Figure  2-4. c 


2.7  Accuracy  of  the  Estimation 

One  of  the  benefits  of  using  Deming's  method  for  the  maximum  likelihood 
estimate  is  that  the  covariance  of  the  estimated  parameters  is  approximated  by  the 
inverse  of  the  matrix  D  defined  by  equation  (2-45)  [Bard  1974],  This  lets  us  quickly 
determine  if  the  estimation  of  the  acoustic  beacon's  position  is  acceptable,  or  if  more 
experimental  data  needs  to  be  collected  to  improve  the  estimation.  We  are  also  able  to 
test  if  the  assumptions  made  regarding  the  covariance  matrix  of  die  measurement 
errors  are  valid  by  examining  the  final  residual  vectors.  We  define  a  moment  matrix 
M  as: 


m  -  t  K  <  <2-72) 

i»-i 

where  the  e*  's  are  the  final  residual  vectors.  To  estimate  the  covariance  of  the 
residuals  we  take: 

v  =  _1_  M  (2-73) 

n  -3 

where  n  is  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation.  Because  of  the  nature  of  the  constrained  minimization  problem,  the  first 
term  in  equation  (2-73)  is  needed  to  correct  for  bias  [Bard  1974],  We  can  compare 
the  outcome  of  equation  (2-73)  to  the  assumed  covariance  matrix  VM  defined  by 
equation  (2-17)  to  see  if  the  estimated  covariance  matrix  V„  is  valid. 
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2.8  Summary 

In  this  chapter  we  have  developed  the  maximum  likelihood  estimate  of  die 
acoustic  beacon's  position,  and  a  means  in  which  to  gauge  the  accuracy  of  the 
estimation.  To  estimate  the  beacon's  position  we  defined  a  structural  model  that 
requires  the  observer  to  measure  the  time  of  receipt  and  location  of  receipt  of  two 
different  signal  from  the  acoustic  beacon.  The  choice  of  how  far  apart  the  two  signals 
that  define  an  experiment  vector  (wM)  must  be,  and  the  number  of  experiment  vectors 
to  use  in  the  parameter  estimation  problem  (n)  remain  as  free  parameters.  In  chapter 
IV  we  examine  the  performance  of  the  algorithm  of  this  chapter  for  different  choices 
of  these  two  free  parameters. 
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Chapter  III 

Moving  Acoustic  Beacon 

3.1  Introduction 

In  chapter  n  we  developed  the  maximum  likelihood  estimator  for  a  stationary 
acoustic  beacon.  In  this  chapter  we  extend  the  solution  to  include  a  moving  acoustic 
beacon.  The  task  of  localizing  an  arbitrarily  moving  acoustic  beacon  is  quite  difficult. 
Abrupt  changes  in  the  acoustic  beacon's  velocity  are  difficult  to  parameterize  and 
model.  Therefore,  we  concentrate  on  the  case  of  an  acoustic  beacon  which  moves  in  a 
constant  velocity,  linear  path.  The  assumption  of  constant  velocity,  linear  motion  is  a 
reasonable  assumption  for  acoustic  beacons  located  on  instruments  ascending  at 
terminal  velocity  from  the  bottom,  or  for  acoustic  beacons  located  on  instruments 
moving  with  an  ocean  current  that  is  steady  in  the  area  of  interest.  With  die 
assumption  of  constant  linear  motion,  we  modify  the  structural  model  given  by 
equation  (2-19)  to  include  parameters  that  reflect  die  acoustic  beacon's  velocity.  Once 
the  new  structural  model  is  defined,  we  show  that  the  solution  to  die  maximum 
likelihood  estimate  for  the  moving  beacon  follows  directly  from  the  solution  to  the 
maximum  likelihood  estimate  for  the  stationary  acoustic  beacon.  Next,  die  algorithm 
developed  to  solve  die  stationary  acoustic  beacon  localization  problem  is  extended 
using  the  new  structural  model  so  that  die  position  and  velocity  parameters  of  die 
moving  acoustic  beacon  can  be  determined.  Finally,  the  accuracy  of  die  estimator  is 
examined. 
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3.2  Problem  Geometry 


Consider  an  acoustic  beacon  having  constant  velocity  components  given  by 
vx,  vy,  and  vz.  We  define  a  new  parameter  vector: 


0  =  i  *o  y<>  v*  v,  vz  ]r  (3-1) 

where  the  coordinates  x0,  y0,  and  z„  define  the  acoustic  beacon's  initial  position  on  the 
same  Cartesian  coordinate  system  that  was  described  in  chapter  II.  For  convenience, 
we  assume  the  velocity  components  vx,  vy,  and  v2  have  the  units  of  meters  per  second. 
The  position  of  the  acoustic  beacon  at  an  arbitrary  time  tp  can  by  found  using: 


XT 

Vx 

yr 

s 

y. 

*7  . 

Vz. 

(3-2) 


where  T„  is  the  reference  time  that  corresponds  to  the  acoustic  beacon's  initial  position 


x0.  y«>  Zo- 

As  in  chapter  II,  we  define  a  measurement  vector  mM  as: 


">,  =  (*„  y,  t„  f  («) 

Where  xM  and  are  the  ship's  coordinates,  in  meters,  on  the  same  local  Cartesian 
coordinate  system  defined  for  the  acoustic  beacon,  and  t,M  is  *he  synchronized  time  of 
receipt  that  corresponds  to  the  observer's  position  xp,  yM. 
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33  Modified  Structural  Model 


To  account  for  the  linearly  moving  acoustic  beacon,  we  redefine  the  function 
f(mp,  G)  from  chapter  II  as: 

/( "V  6 >  {3_4 

■  tg It ) 

where  tp  represents  the  time  that  the  acoustic  beacon  transmitted  the  signal  that  the 
observer  received  at  the  synchronized  time  of  receipt  t(|l.  Using  the  same 
homogeneous  ocean  model,  and  direct  path  propagation  from  chapter  II,  we  simplify 
equation  (3-4)  to: 


.rtv  e> s  fa  -T*>vyf%% 

-  C(tg,-Tc) 


(3-5) 


Now  assume  that  at  time  T0  the  acoustic  beacon  transmitted  the  first  signal  that  the 
observer  receives.  To  find  when  the  current  signal  received  at  the  synchronized  time 
of  receipt  t1(1  was  transmitted,  we  note  that  the  acoustic  beacon  transmits  a  signal  for 
every  pulse  repetition  interval.  With  T0  as  a  reference,  tp  can  be  found  by: 


tp  =  TQ  +  i'Tp  (3-6) 

where  Tp  is  the  pulse  repetition  interval  of  the  acoustic  beacon  and  /  is  number  of 
pulse  repetition  intervals  that  separate  the  signal  transmitted  at  time  tp  from  the  signal 
transmitted  at  reference  time  T„.  To  determine  f,  the  observer  counts  how  many 
signals  are  received  between  the  first  received  signal  and  the  signal  received  at  the 


i(>v  «)  =  ,/(*, Tp ■  v/ .(#, - vf ' Tr  v/ *(Vi ' •  v/ 

-•j(i2-*.-j-Tp-'’j‘><32-y.-J-Tp-vfHzt+)-Tp-V'f  <3-,0> 

*(4i“4a) 

This  is  analogous  to  equation  (2-19)  with  additional  terms  included  to  correct  for  the 
beacon's  motion. 

3.4  Maximum  Likelihood  Estimator  Solution 

The  solution  to  the  maximum  likelihood  estimation  problem  for  the  case  of  the 
moving  acoustic  beacon  follows  directly  from  the  solution  to  the  maximum  likelihood 
estimation  problem  for  the  case  of  the  stationary  acoustic  beacon.  Since  only  the 
structural  model  has  changed,  the  likelihood  function  log  (L  (W,  V)),  the  Lagrangian 

function  A(\V,  0,  V,  X . ,XJ  and  the  objective  function  <I>(  W-)  all  have  the  same 

form  as  the  corresponding  functions  defined  for  the  stationary  beacon.  To  solve  for 
the  maximum  likelihood  estimator  of  the  parameter  vector  0,  we  simply  substitute  the 
modified  structural  model  given  by  equation  (3-10)  for  the  stationary  structural  mode 
given  by  equation  (2-19),  and  follow  the  method  of  Deming  described  in  chapter  II. 
There  are,  however,  a  few  differences  that  must  be  accounted  for. 

If  the  measurement  errors  are  the  same  for  both  cases,  we  still  expect  the 
solution  to  the  maximum  likelihood  estimator  to  be  suboptimal.  Because  of  the 
uniform  distribution  of  the  measurement  errors  Tt|t,  we  must  continue  to  confine  the 
solution  of  the  maximum  likelihood  estimation  problem  to  a  feasible  region.  With  the 
addition  of  the  parameters  vx,  vy,  and  vt  to  0,  we  expand  the  feasible  region  defined  by 
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equation  (2-48)  to: 


- Range ^  Range^ 

*  y0  *  *»««■, 

-Depths 

*  V,  *  **_ 

-y,«  *  v,  *  vr. 

-V,  S  V,  i  V, 

*mn  *  *mx 


(3-11) 


As  in  chapter  II,  to  maintain  a  feasible  solution,  we  break  59  into  component  parts: 

- e,v  to  -  e;  *  P,  u,  <*-**> 

where  Ue  is  unit  magnitude  vector  that  describes  the  direction  of  59,  and  pe  is  the 
magnitude  of  59.  We  assume  that  69,  and  therefore  Ue  ,  points  in  the  proper 
direction  to  the  maximum  likelihood  estimator.  If  9*+  59  is  outside  the  feasible 
region  defined  by  equation  (3-11),  we  find  the  maximum  value  of  p  that  satisfies: 


-Range^ 

Range** 

-Range^ 

Range^ 

-Depthm 

0 

-v 

<  e;  +  paav9< 

v„ 

"v*» 

VJ- 

"vw  . 

V 

(3-13) 


Once  we  have  found  paix,  we  define  the  new  recursion  relations: 
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(3-14) 


e;.i 

ft 
ft 

As  with  the  case  of  the  stationary  acoustic  beacon,  if,  after  a  few  iterations,  6*  lies  on 
the  edge  of  the  feasible  region,  pBR  will  be  zero  and  0*+1  will  equal  6*  for  all 
subsequent  iterations.  If  this  happens  we  reject  the  estimate,  and  try  again  using  a 
different  initial  value  for  6* ,  or  more  experimental  data  points. 

3i  Algorithm 

Figure  3-1  at  the  end  of  this  section  describes  the  algorithm  used  to  solve  for 
the  acoustic  beacon's  position  and  velocity.  The  algorithm  is  essentially  die  same 
algorithm  developed  in  chapter  II  with  changes  made  to  account  for  die  modified 
structural  model  of  equation  (3-10).  Because  of  the  modified  structural  model,  we 
must  reevaluate  the  quantities  a,,  and  bH  From  equation  (3-10),  we  define  the 
quantities: 


dx  ■  VW -*o  -yo  -i  T/Vyf  +  & 


(3-15) 


<4  ■ 


(3-16) 


a,,  and  bM  are  then  given  by: 
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(3-17) 


(3-18) 


To  evaluate  the  structural  model,  and  the  terms  aM  and  bM  ,we  need  to  know  the 
values  of  i  and  j  that  represent  the  time  that  the  received  signals  were  transmitted. 

This  forces  the  observer  to  keep  a  count  of  the  number  of  signals  that  are  received, 
with  the  first  received  signal  corresponding  to  /  =  0. 

Once  we  have  found  the  maximum  likelihood  estimate  of  the  parameter  vector 
6,  we  need  to  evaluate  the  estimated  current  position  of  the  acoustic  beacon.  The 
position  defined  by  xa*,  y0\  zj  is  the  estimated  initial  position  of  the  acoustic  beacon 
at  the  time  T„.  We  assume  that  the  time  T0  corresponds  to  the  case  i-  0.  To 
determine  the  current  position  of  the  acoustic  beacon,  we  project  the  solution  forward 
along  the  path  described  by  the  estimated  velocity  components  vx*,  vy\  vz*.  The 
estimated  current  position  of  the  acoustic  beacon  is  then  given  by: 


♦ 

XT 

*0 

* 

• 

yT 

= 

yl 

+  iTp 

♦ 

♦ 

.Zt 

• 

Zo 

• 

v* 

(3-19) 


where  i  is  the  total  number  of  beacon  signals  received  and  Tp  is  the  pulse  repetition 
interval  of  the  acoustic  beacon.  The  quantity  (/'  •  Tp)  represents  the  time  it  took  to 


collect  the  measurements  used  to  calculate  the  maximum  likelihood  estimator. 


To  Figure  3-l.b 


Figure  3-1. a 
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From  Figure  3-1. a 


To  figure  3-l.c 


Figure  3-l.b 
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From  Figure  3-l.b 


Figure  3-l.c 
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3.6  Accuracy  of  the  Estimator 

To  estimate  the  accuracy  of  the  solution  to  the  maximum  likelihood  estimator, 
we  examine  the  estimated  covariance  matrix  of  the  parameter  vector  6.  As  with  the 
stationary  beacon,  the  estimated  covariance  matrix  of  the  parameter  vector  8  is  given 
by  the  inverse  of  the  matrix  D  or. 


>t  r- 1  p 


(  " 

V 

* 

> 

£ 

• b  b 

V  n-i 

-l 


(3-20) 


The  variance  of  the  velocity  components  vx‘,  vy‘,  and  \\  are  the  last  three  diagonal 
elements  of  the  covariance  matrix  Vq. 

To  determine  the  variances  of  the  current  acoustic  beacon  position  estimates  we 
calculate: 


‘E\^iT,vx)-E[x.*i-Tpv,f] 

(3-21) 

(3-22) 

(3-23) 

Simplifying  equations  (3-21)  through  (3-23)  yields: 

+  (i'r,)2'<\2  +  2V'Tp)E{X'VA 


(3-24) 


2  =  „  2 


JT 


-  E[y0f -2-(i-Tp)E[vy  ]E[yo]  -(i'Tp-E[vy]f 


56 


(3-25) 


(3-26) 


°«r  *  *  (i'Trf'a\  *  2'(i'If)B[^v,] 

-  B[z,f  -2-(|--T,)fi[v,  ]E[Z.]  -( i-TF-E[vt  ]f 

Now  if  we  assume  that  the  estimate  of  the  parameter  vector  0  is  unbiased,  we  can 
substitute  the  estimated  parameter  values  for  their  means  in  equations  (3-24)  through 
(3-26).  This  gives  us  a  method  in  which  to  calculate  the  estimated  variance  of  the 
projected  current  position: 

<  -  +  (*■*,?■<  *  2'(i'7p)£hv.] 

-  (xi?  -2 \i-Try,xi  f 

-  tit -m-T,)v,y; 

-  z; -{i-Tp-v;f 
From  equations  (3-27)  through  (3-29)  we  see  that  the  variance  of  the  estimated  current 
position  has  a  complex  relationship  to  the  number  of  experiment  vectors  used  and  the 
effective  sensor  spacing.  As  these  quantities  increase,  we  expect  that  the  variances  of 
the  estimated  initial  positions  and  velocities  will  decrease.  However,  as  the  number  of 
experiment  vectors  used  and  the  effective  sensor  spacing  increases,  the  term  i  will 
increase  and  the  variance  of  the  estimate  of  the  current  position  of  the  acoustic  beacon 
can  also  increase.  This  is  because  if  we  project  the  initial  position  of  the  acoustic 
beacon  forward  based  on  the  estimated  velocity  parameters,  any  errors  in  the  acoustic 


(3-27) 


(3-28) 


(3-39) 
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beacon's  velocity  causes  us  to  move  the  estimate  in  the  wrong  direction.  The  choice 
of  how  many  experiment  points  to  collect,  or  how  long  we  spend  collecting  data 
points,  will  be  examined  in  chapter  IV. 

As  with  the  stationary  beacon,  we  can  test  the  assumptions  made  regarding  the 
covariance  matrix  of  the  measurement  errors.  We  define  die  moment  matrix  as: 

M  -  £  <  kt  (M#> 

ii-i 

where  the  e*  's  are  the  final  residual  vectors  defined  as  in  chapter  II.  To  estimate  the 
covariance  of  the  residuals  we  take: 

V  =  'M  (3-31) 

n -6 

where  n  is  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation.  The  first  term  in  equation  (3-31)  corrects  for  the  bias  caused  by  the 
constrained  minimization  problem  [Bard  1974].  We  can  compare  the  results  of 
equation  (3-31)  with  the  assumed  covariance  matrix  of  the  measurement  errors  to 
judge  if  the  assumed  covariance  matrix  VM  is  valid. 

3.7  Summary 

In  this  chapter  we  have  extended  the  results  of  chapter  II  to  include  linear 
motion  of  the  acoustic  beacon.  We  found  that  the  solution  to  the  maximum  likelihood 
estimator  for  the  case  of  the  moving  beacon  follows  the  same  form  as  the  solution  for 
the  case  of  the  stationary  beacon.  The  quantity  (j  -  r)  is  one  of  the  free  parameters  of 
the  moving  acoustic  beacon  estimation  problem.  We  define  this  quantity  as  the 
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effective  sensor  spacing.  This  quantity  corresponds  to  the  spacing  in  time  between  the 
two  signals  used  to  form  the  experiment  vector  wr  The  other  free  parameter  is  the 
number  of  experiment  vectors  to  use  in  the  parameter  estimation  problem.  In  the  next 
chapter  we  examine  the  performance  of  the  algorithm  described  in  this  chapter  for 
different  choices  of  the  two  free  parameters. 
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Chapter  IV 

Algorithm  Simulations  and  Tests 

4.1  Introduction 

In  chapters  II  and  III  we  developed  algorithms  to  solve  for  die  maximum 
likelihood  estimate  of  an  acoustic  beacon's  position  for  both  die  stationary  and  the 
moving  beacon.  In  both  chapters  we  were  left  with  choosing  how  many  experiment 
vectors  (wM)  to  use,  and  which  measurement  vectors  (mM)  to  use  to  define  die 
experiment  vectors.  We  defined  the  effective  element  spacing  to  be  die  number  of 
pulse  repetition  intervals  (Tp)  between  the  measurement  vectors  that  form  the 
experiment  vector  wM.  In  this  chapter  we  examine  the  performance  of  the  algorithms 
developed  in  chapters  II  and  m  for  different  numbers  of  experiment  vectors,  and  for 
different  effective  element  spacings.  We  show  that  die  accuracy  of  die  estimated 
beacon  position  (6*)  improves,  while  tne  variance  of  die  estimated  position  decreases 
as  the  number  of  experiment  vectors  used  to  find  the  maximum  likelihood  estimate 
increases.  We  also  show  that  the  accuracy  of  the  estimated  beacon  position  improves, 
and  the  variance  of  the  estimated  position  decreases  with  increased  effective  sensor 
spacing.  This  result  is  similar  to  the  methods  mentioned  in  chapter  I. 

To  test  the  algorithms  of  chapters  II  and  III,  Monte  Carlo  simulations  were 
conducted  for  several  different  initial  positions  and  velocities  of  the  acoustic  beacon. 
Results  from  six  of  the  scenarios  tested  are  presented  in  the  following  sections.  We 
assume  that  the  measurement  errors  are  as  defined  in  section  2.4.  To  see  how  the 
accuracy  of  the  measured  position  of  receipt  (xp,  y„)  affects  die  maximum  likelihood 
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estimate,  we  use  GPS  errors  of  3  meters  rms  and  25  meters  rms.  These  errors 
approximate  the  errors  of  a  Differential/P  code  GPS  receiver  and  a  C/A  code  GPS 
receiver  respectively.  For  measurement  errors  in  the  synchronized  time  of  receipt  t^, 
we  assume  the  sampling  rate  of  the  receiver,  T„  is  1  millisecond  and  use  equation  (2- 
16)  to  define  the  variance. 

4.2  Synthetic  Measurement  Vector  Generation 

To  test  the  algorithms  of  chapters  II  and  III,  synthetic  measurement  vectors 
were  generated  for  several  different  acoustic  beacon  positions  and  velocities.  Table 
4-1  lists  the  initial  position  and  velocities  for  each  of  the  scenarios  presented.  We 
assume  that  the  receiving  ship  moves  in  a  hexagonal  search  path  with  legs  of  1000 
meters.  This  is  a  reasonable  search  path  in  the  general  location  of  die  acoustic 
beacon  which  is  easy  to  model.  The  actual  path  of  the  receiving  ship  is  not  critical. 


Scenario 

(m) 

yB 

(m) 

m 

v, 

(m/s) 

vr 

(m/s) 

v, 

(m/s) 

1 

0 

0 

-2000 

0 

0 

0 

2 

0 

866 

-2000 

0 

0 

0 

3 

-1000 

1000 

-2000 

0 

0 

0 

4 

0 

0 

-2000 

0.5 

-0.5 

0.25 

1  5 

0 

866 

-2000 

0.5 

-0.5 

0.25 

1  6 

-1000 

1000 

-2000 

0.5 

-0.5 

0.25 

Table  4-1 

as  long  as  it  is  not  linear.  If  the  receiving  ship's  path  is  linear  we  will  be  unable  to 
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accurately  resolve  the  acoustic  beacon's  position  in  three  dimensions.  This  is 
analogous  to  the  inability  of  a  conventional  linear  array  to  resolve  the  direction  of 
arrival  of  a  signal  in  two  dimensions.  We  restrict  the  speed  of  die  receiving  ship  to 
five  meters  per  second  so  that  flow  noise  does  not  become  a  problem. 

Figure  4-1  shows  the  positions  of  the  acoustic  beacon  for  die  scenarios  defined 
in  Table  4-1  compared  to  die  path  of  the  receiving  ship. 


Figure  4-1 

Scenarios  1  and  4  corresponds  to  an  acoustic  beacon  located  in  the  center  of  the  search 
path,  scenarios  2  and  5  correspond  to  an  acoustic  beacon  located  directly  below  the 
search  path,  and  scenarios  3  and  6  correspond  to  an  acoustic  beacon  located  outside  of 
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the  search  path. 

To  generate  the  synthetic  measurement  vectors  mM,  we  solve  for  the  intercept  of 
the  receiving  ship  and  the  beacon  signal.  Figure  4-2  shows  the  intercept  geometry. 

(x,  ■  y„’  °) 

y, .  o) 

Acoustic  Beacon 
Location 

(xb-  yB>  zb) 

Figure  4-2 

The  position  Xj,  y,  is  the  location  of  the  receiving  ship  when  the  beacon  signal  is 
transmitted,  and  the  position  x^,  yM  is  the  location  of  the  ship  when  the  beacon  signal 
is  received.  Using  a  homogeneous  ocean  model  and  a  direct  path  propagation  mode, 
we  calculate  the  synchronized  time  of  receipt  by  finding  the  positive  root  of: 

a  +  P 't  +y  =  0 

where: 


a  =  s2  -C2 

P  =  2  -s  •  [  cos(  cse )  <*, -j:^)  +  sin(cse )  iyt  -y^]  (4-2) 

Y  =  (x,-xB)2+(yryBf  +zl 
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Here  s  is  the  speed  of  the  receiving  ship  in  meters  per  second,  C  is  the  speed  of  sound 
in  sea  water,  and  cse  is  the  course  of  the  receiving  ship  in  degrees.  It  is  assumed  that 
the  receiving  ship  does  not  change  its  course  for  the  duration  of  the  calculation.  Once 
we  have  the  synchronized  time  of  receipt,  we  calculate  the  position  of  receipt  x„,  yM 
using: 


(4-3) 


*  *,♦*„•*•  cos(cae) 

=  yt  +  t^‘S'sm(cse) 

To  find  the  next  synchronized  time  of  receipt  and  position  of  receipt  (xM,  yM) 
we  update  the  acoustic  beacon's  position  based  on  its  velocity: 


**  =  +  Vv* 

yB  =  yB*TP‘yj  (4~4) 

=  Zb  +  tp'\ 

where  Tp  is  the  pulse  repetition  interval  of  the  acoustic  beacon.  For  the  results 
presented  in  the  following  sections  we  assume  the  acoustic  beacon  has  a  pulse 
repetition  interval  of  2  seconds.  Next  we  find  the  location  of  the  receiving  ship  when 
the  new  beacon  signal  is  transmitted  using. 


x,  =  x,  +  Tp  s  •  cos(cse) 

y,  =  y,  +  Tp-S-  sin(cse) 


(4-5) 


We  then  solve  for  the  intercept  of  the  beacon  signal  and  the  receiving  ship  using 
equations  (4-1)  and  (4-2).  We  continue  in  this  manner  until  we  have  generated  a 
sufficient  number  of  measurement  vectors  mM.  Once  we  have  generated  the 
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measurement  vectors,  we  add  normally  distributed  random  error  terms  to  each 
measurement  based  upon  the  errors  discussed  in  section  2.4. 

4J  Stationary  Acoustic  Beacon 

In  this  section  we  examine  die  performance  of  the  algorithm  given  in  Figure 
2-4.  Figures  4-3  through  4-50  contain  the  results  of  die  Monte  Carlo  simulations 
conducted  for  scenarios  1  through  3.  For  each  scenario,  the  initial  value  of  the 
estimated  parameter  vector  0*  is  taken  as: 

0o  =  [  0  0  -2500  ]r  (4'6> 

The  feasible  region  is  defined  by  RangeB„  *  DepthB„  =  5000  meters.  If  die  maximum 
likelihood  estimate  found  using  the  algorithm  of  chapter  II  is  outside  the  feasible 
region,  the  corresponding  entries  are  left  blank.  To  find  a  solution  for  these  cases,  we 
need  to  start  with  a  different  initial  parameter  vector  0*,  or  use  more  experiment 
vectors. 

To  test  the  effect  of  increasing  the  number  of  experiment  vectors  (n),  we  solve 
for  the  estimated  parameter  vector  0*  using  n  ranging  from  5  to  50.  We  fix  die 
effective  sensor  spacing  at  45  pulse  repetition  intervals  by  using  every  45*  received 
beacon  signal  in  defining  the  experiment  vectors.  To  test  die  effects  oi  ucreasing  the 
effective  sensor  spacing,  we  solve  for  the  estimated  position  vector  usuig  effective 
sensor  spacings  ranging  from  2  to  90  pulse  repetition  intervals.  For  this  case  we  fix 
die  number  of  experiment  vectors  used  to  25.  We  conduct  each  experiment  using  GPS 
errors  of  3  meters  rms  and  25  meters  rms.  The  results  of  the  estimation  algorithm  for 
GPS  errors  of  3  meters  rms  are  shown  by  x's  on  the  plots,  while  the  results  of  die 


estimation  algorithm  for  GPS  errors  of  25  meters  rms  are  shown  by  o's. 

4J.1  Scenario  1  -  Stationary  Acoustic  Beacon  Located  at  0  =  [0  0  -2000] 

Figures  4-3  through  4-10  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-11 
through  4-18  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  1.  We  see  that  in  general,  as  the 
number  of  experiment  vectors  used  in  the  maximum  likelihood  estimation  problem 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.  Also,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.  For  both  cases,  the  position  errors  and 
the  standard  deviation  of  the  estimates  initially  decrease  rapidly  as  the  receiving  ship 
spans  more  of  its  two  dimensional  search  path.  However  after  the  number  of 
experiment  vectors  used  reaches  approximately  20,  or  after  the  effective  sensor  spacing 
reaches  approximately  35,  the  errors  and  the  standard  deviations  decrease  at  much 
slower  rate.  At  this  point  the  receiving  ship  has  completed  two  legs  of  the  search 
path,  and  spans  enough  of  the  two  dimensional  search  path  to  form  a  decent  estimate 
of  the  acoustic  beacon's  position. 
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ZT  vs  Number  of  Experiment  Vectors  Standard  Deviation  of  ZT 
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Effective  Sensor  Spacing  Effective  Sensor  Spacing 


ZT  vs  Effective  Sensor  Spacing  Standard  Deviation  of  ZT 


SJ0J9UJ 


SJ0J0U1 


70 


Effective  Sensor  Spacing  Effective  Sensor  Spacing 


43.2  Scenario  2  -  Stationary  Acoustic  Beacon  Located  at  6  =  (0  866  -2000]T 

Figures  4-19  through  4-26  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-27 
through  4-34  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  2.  Like  scenario  1,  as  the  number  of 
experiment  vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the 
accuracy  of  the  estimated  beacon  position  improves,  and  the  standard  deviation  of  the 
estimated  position  decreases.  Also  like  scenario  1,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.  Again  we  see  an  initial  rapid  decrease 
in  the  errors  and  standard  deviations  which  levels  off  after  the  number  of  experiment 
vectors  used  reaches  approximately  20,  or  the  effective  sensor  spacing  reaches 
approximately  35.  As  in  scenario  1,  these  values  correspond  to  when  the  receiving 
ship  completes  the  second  leg  of  the  search  path. 

Unlike  scenario  1,  we  see  a  significant  improvement  in  the  estimated  position 
(especially  when  using  25  meter  GPS  errors)  when  the  number  of  experiment  vectors 
used  is  greater  then  40,  or  the  effective  sensor  spacing  is  greater  then  65.  At  this 
point  the  receiving  ship  passes  directly  over  the  acoustic  beacon  and  begins  moving 
away  from  the  beacon  on  the  fourth  leg  of  the  search  path.  To  see  why  we  get  this 
improvement,  we  can  define  a  vertical  plane  as  the  plane  orthogonal  to  the  x-y  plane 
that  passes  through  the  acoustic  beacon's  position  and  the  starting  point  of  the  leg  of 
the  search  path  that  the  receiving  ship  is  currently  on.  In  general,  it  was  found  that  if 
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the  receiving  ship  moves  such  that  it  stays  in  this  vertical  plane,  significant 
improvements  to  the  estimated  beacon  location  can  be  made.  This  is  because  as  the 
receiving  ship  moves  in  the  same  vertical  plane  relative  to  die  acoustic  beacon,  the 
localization  problem  is  essentially  a  two  dimensional  problem,  and  the  range 
differences  between  measurement  vectors  is  maximized  for  a  given  ship's  velocity. 
The  same  is  true  if  the  acoustic  beacon  and  the  receiving  ship  are  in  die  same 
horizontal  plane. 
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ZT  vs  Number  of  Experiment  Vectors  Standard  Deviation  of  ZT 


XT  vs  Effective  Sensor  Spacing  Standard  Deviation  of  XT 
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4.3.3  Scenario  3  -  Stationary  Acoustic  Beacon  Located  at  0  =  [-1000  1000  -2000]T 

Figures  4-35  through  4-42  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-43 
through  4-50  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacing  for  scenario  3.  Like  the  first  two  scenarios,  as  the 
number  of  experiment  vectors  used  in  the  maximum  likelihood  estimation  problem 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  while  the  standard 
deviation  of  the  estimated  position  decreases.  Also,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  while  the  standard 
deviation  of  the  estimated  position  decreases.  Again  we  see  an  initial  rapid  decrease 
in  the  errors  and  standard  deviations  which  levels  off  after  the  number  of  experiment 
vectors  used  reaches  approximately  20,  and  the  effective  sensor  spacing  reaches 
approximately  35.  As  in  the  first  two  scenarios,  these  values  correspond  to  when  the 
receiving  ship  completes  the  second  leg  of  the  search  path. 

In  this  scenario,  we  see  a  significant  improvement  in  the  location  estimate 
when  the  number  of  experiment  vectors  used  is  greater  then  45,  or  when  the  effective 
element  spacing  is  greater  then  75.  At  this  point  the  receiving  ship  passes  through  the 
closest  point  of  approach  to  the  acoustic  beacon  on  the  fifth  leg  of  the  search  path.  In 
general,  it  was  found  that  the  estimate  of  the  acoustic  beacon's  location  improves  as 
the  receiving  ship  passes  through  closest  points  of  approach  to  the  acoustic  beacon 
along  the  search  path. 
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s  Number  of  Experiment  Vectors  Standard  Deviation  of  ZT 


ZT  vs  Effective  Sensor  Spacing  Standard  Deviation  of  ZT 
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43.4  Stationary  Acoustic  Beacon  Summary 

From  scenarios  1  through  3  we  showed  that  as  the  number  of  experiment 
vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the  accuracy  of 
the  estimated  beacon  position  improves,  while  the  standard  deviation  of  the  estimated 
position  decreases.  Also,  as  the  effective  sensor  spacing  increases,  the  accuracy  of  the 
estimated  beacon  position  improves,  while  the  standard  deviation  of  the  estimated 
position  decreases.  We  also  showed  that  as  the  receiving  ship  passes  through  a  closest 
point  of  approach,  the  estimated  position  of  the  acoustic  beacon  improves.  This  is 
why  the  estimate  of  acoustic  beacon's  location  in  scenario  1  is  better  then  the  estimates 
obtained  for  the  other  two  scenarios.  In  scenario  1,  each  leg  of  the  search  path  passes 
through  a  closest  point  of  approach.  This  is  not  true  for  the  other  two  scenarios.  In 
all  of  the  scenarios,  we  see  that  the  depth  of  the  acoustic  beacon  is  the  least  accurately 
estimated  parameter.  This  is  because  we  are  attempting  to  locate  the  acoustic  beacon 
in  three  dimensions,  while  the  receiving  ship  only  moves  in  two  dimensions.  Finally, 
we  see  that  the  accuracy  of  the  estimated  acoustic  beacon  position  obtained  from  using 
GPS  errors  of  3  meters  is  approximately  an  order  of  magnitude  better  then  the 
estimated  acoustic  beacon  position  obtained  from  using  GPS  errors  of  25  meters. 

These  observations  suggest  that  to  obtain  the  best  possible  estimate  of  the 
acoustic  beacon's  location,  we  need  to  use  a  large  number  of  experiment  vectors  with  a 
large  effective  sensor  separation,  and  we  need  to  use  a  Differential/P  code  GPS 
receiver.  The  problem  with  this  is  that  the  time  it  takes  to  collect  the  measurement 
vectors  used  to  form  the  experiment  vectors  increases  with  increasing  sensor  spacing 


82 


and  increasing  numbers  of  experiment  vectors.  As  an  example,  with  an  effective 
sensor  spacing  of  45  pulse  repetition  intervals,  a  pulse  repetition  interval  of  2  seconds, 
and  using  50  experiment  vectors  it  takes  over  76  minutes  to  collect  the  required 
measurement  vectors.  If  time  is  an  issue,  then  we  must  use  fewer  experiment  vectors 
and  shorter  effective  sensor  spacings.  From  looking  at  the  results  of  the  simulations 
presented  above,  for  the  hexagonal  search  path  of  figure  4-1  and  for  a  pulse  repetition 
interval  of  2  seconds,  the  minimum  required  number  of  experiment  vectors  is  20,  and 
the  minimum  effective  sensor  spacing  is  35.  With  these  values  we  span  enough  of  the 
two  dimensional  search  path  to  obtain  a  decent  estimate  of  the  acoustic  beacon's 
location. 

4.4  Moving  Acoustic  Beacon 

In  this  section  we  examine  the  performance  of  the  algorithm  given  in  Figure 
3-1.  Figures  4-51  through  4-146  contain  the  results  of  the  Monte  Carlo  simulations 
conducted  for  scenarios  4  through  6.  For  each  scenario,  the  initial  value  of  the 
estimated  parameter  vector  8*  is  taken  as: 

0;  =  [  0  0  -2500  0  0  Of  (4-?) 

The  feasible  region  is  defined  by  Range„„  =  Depths  =  5000  meters,  and  v^,^  = 
vym«  =  vDn«  =  5  meters  per  second.  If  the  maximum  likelihood  estimate  found  using 
the  algorithm  of  chapter  III  is  outside  the  feasible  region,  the  corresponding  entries  are 
left  blank.  To  find  a  solution  for  these  cases,  we  need  to  start  with  a  different  initial 
parameter  vector  0,  or  use  more  experiment  vectors. 

To  test  the  effect  of  increasing  the  number  of  experiment  vectors  (n),  we  solve 
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for  the  estimated  parameter  vector  9*  using  n  ranging  from  10  to  50.  We  fix  the 
effective  sensor  spacing  at  60  pulse  repetition  intervals  by  using  every  60th  received 
beacon  signal  in  defining  the  experiment  vectors.  7  ■*  test  the  effect  of  increasing  the 
effective  sensor  spacing,  we  solve  for  the  estimated  position  vector  using  effective 
sensor  spacings  ranging  from  2  to  90  pulse  repetition  in&rvals.  For  this  case  we  fix 
the  number  of  experiment  vectors  used  to  30.  We  conduct  each  experiment  using  GPS 
errors  of  3  meters  rms  and  25  meters  rms.  The  results  of  the  estimation  algorithm  for 
GPS  errors  of  3  meters  rms  are  shown  by  x's  on  the  plots,  while  the  results  of  the 
estimation  algorithm  for  GTS  errors  of  25  meters  rms  is  shown  by  o's. 

4.4.1  Scenario  4  -  Moving  Acoustic  Beacon  Located  at: 

0  =  (0  0  -2000  0.5  -0.5  0.25|t 

Figures  4-51  through  4-66  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-67 
through  4-82  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  4.  Similar  to  the  stationary  acoustic 
beacon  scenarios,  we  see  that  as  the  number  of  experiment  vectors  used  in  the 
maximum  likelihood  estimation  problem  increases,  the  accuracy  of  the  estimated 
position  and  velocities  of  the  acoustic  beacon  improves,  while  die  standard  deviation 
of  the  estimated  position  and  velocities  decrease.  We  also  see  that  as  the  effective 
sensor  spacing  increases,  the  accuracy  of  the  estimated  position  and  velocities  of  the 
acoustic  beacon  improves,  and  the  standard  deviation  of  the  estimated  position 
decreases.  As  with  the  stationary  acoustic  beacon,  the  position  and  velocity  errors 
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initially  decrease  rapidly,  however,  after  the  number  of  experiment  vectors  used 
reaches  approximately  30,  or  the  effective  sensor  spacing  reaches  approximately  45, 
the  errors  and  the  standard  deviations  decrease  much  slower. 

Figures  4-61  through  4-66  and  figures  4-77  through  4-82  show  the  estimation 
algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon.  We  see  that  projected 
current  positions  follow  the  linearly  moving  acoustic  beacon  fairly  well  when  using  3 
meter  GPS  errors.  We  also  see  that  the  standard  deviation  of  the  projected  current 
positions  decrease  as  the  number  of  experiment  vectors  used  increases  and  the 
effective  sensor  spacing  increases.  However,  we  notice  in  a  few  cases  the  standard 
deviations  increase  slightly  for  increasing  numbers  of  experiment  vectors  used  and 
increas:-^  effective  sensor  spacing.  This  is  a  result  of  projecting  the  current  position 
forward  in  time  using  equation  3-19. 
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s  Number  of  Experiment  Vectors  n4  Standard  Deviation  of  Xo 


Zo  vs  Number  of  Experiment  Vectors  v  in4  Standard  Deviation  of  Zo 
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4.4.2  Scenario  5  -  Mov'.ij  Acoustic  •  r  Located  at: 

,  *■  *:•  ■ 

Fib  ,  c-  -  ow  the  results  of  the  maximum  likelihood 

estimation  algo.  different  numbers  of  experiment  vectors,  and  figures  4-99 

through  4-114  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  5.  Similar  to  the  previous  scenarios, 
we  see  that  as  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation  problem  increases,  the  accuracy  of  the  estimated  position  and  velocities  of 
the  acoustic  beacon  improves,  while  the  standard  deviation  of  the  estimated  position 
and  velocities  decrease.  We  also  see  that  as  the  effective  sensor  spacing  increases,  the 
accuracy  of  the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  and 
the  standard  deviation  of  the  estimated  position  decreases.  As  before,  the  position  and 
velocity  errors  initially  decrease  rapidly,  however  after  the  number  of  experiment 
vectors  used  reaches  approximately  30,  and  die  effective  sensor  spacing  reaches 
approximately  45,  the  errors  and  the  standard  deviations  decrease  much  slower. 

Figures  4-93  through  4-98  and  figures  4-109  through  4-114  show  the  estimation 
algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon  for  this  scenario.  We 
see  that  the  projected  current  positions  follow  die  linearly  moving  acoustic  beacon 
fairly  well  for  both  3  meter  and  25  meter  GPS  errors.  This  is  because  die  estimated 
initial  positions  x0,  y0,  and  \  obtained  using  25  meter  GPS  errors  were  better  in  this 
scenario  then  for  scenario  4.  In  general  this  is  not  the  case,  however  the  measurement 
errors  in  this  scenario  simply  led  to  a  better  estimate  of  the  acoustic  beacon's  position. 
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Zo  vs  Number  of  Experiment  Vectors  1 04  Standard  Deviation  of  Zo 
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4.4.3  Scenario  6  -  Moving  Acoustic  Beacon  Located  at 

e  =  [-10000  1000  -2000  0.5  -0.5  0.25]T 

Figures  4-115  through  4-130  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-131 
through  4-146  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  6.  Again  we  see  that  as  the  number  of 
experiment  vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the 
accuracy  of  the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  and 
the  standard  deviation  of  the  estimated  position  and  velocities  decrease.  We  also  see 
that  as  the  effective  sensor  spacing  increases,  the  accuracy  of  the  estimated  position 
and  velocities  of  the  acoustic  beacon  improves,  while  the  standard  deviation  of  the 
estimated  position  decreases.  As  before,  tite  position  and  velocity  errors  initially 
decrease  rapidly,  however  after  the  number  of  experiment  vectors  used  reaches 
approximately  30,  or  the  effective  sensor  spacing  reaches  approximately  45,  the  errors 
and  the  standard  deviations  decrease  much  slower. 

Figures  4-125  through  4-130  and  figures  4-141  through  4-146  show  the 
estimation  algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon  for  this 
scenario.  We  see  that  the  projected  current  positions  follow  the  linearly  moving 
acoustic  beacon  fairly  well  using  3  meter  GPS  errors.  Again,  because  of  the  errors  in 
estimating  the  acoustic  beacon's  initial  positions  x0,  yD,  and  z„,  the  projected  current 
position  obtained  from  using  25  meter  GPS  errors  does  not  track  the  acoustic  beacon's 
motion  as  well. 
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Xo  vs  Number  of  Experiment  Vectors  v  in4  Standard  Deviation  of  Xo 
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4.4.4  Moving  Acoustic  Beacon  Summaiy 

From  scenarios  4  through  6  we  showed  that  as  the  number  of  experiment 
vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the  accuracy  of 
the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  while  the 
standard  deviation  of  the  estimated  position  decreases.  Also,  as  the  effective  sensor 
spacing  increases,  the  accuracy  of  the  estimated  position  and  velocities  of  the  acoustic 
beacon  improves,  and  the  standard  deviation  of  the  estimated  position  decreases.  For 
all  of  the  moving  acoustic  beacon  scenarios,  we  see  that  the  depth  of  the  acoustic 
beacon  is  the  least  accurately  estimated  parameter.  This  is  because  we  are  still 
attempting  to  locate  the  acoustic  beacon  in  three  dimensions,  while  the  receiving  ship 
only  moves  in  two  dimensions.  We  also  note  that  the  standard  deviations  of  the 
estimated  beacon  position  are  significantly  larger  for  the  moving  beacon  scenarios  then 
for  the  stationary  beacon  scenarios.  These  larger  standard  deviations  are  due  to  the 
nature  of  the  structural  model  and  reflect  the  difficulties  in  locating  a  moving  acoustic 
beacon  using  only  a  single  omnidirectional  hydrophone  as  a  receiving  source. 

Similar  to  the  stationary  acoustic  beacon  scenarios,  to  obtain  the  best  possible 
estimate  of  the  acoustic  beacon's  location  we  need  to  use  a  large  number  of  experiment 
vectors  with  a  large  effective  sensor  spacing.  Again  we  run  into  problems  with  the 
time  it  takes  to  collect  the  required  measurement  vectors.  For  example,  with  an 
effective  sensor  spacing  of  60  pulse  repetition  intervals,  a  pulse  repetition  interval  of  2 
seconds,  and  using  50  experiment  vectors  it  takes  100  minutes  to  collect  the  required 
measurement  vectors.  As  with  the  stationary  acoustic  beacon  scenarios,  if  time  is  an 
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issue,  we  must  reduce  the  number  of  experiment  vectors  used,  and  reduce  the 
effective  sensor  spacing.  As  a  minimum,  we  must  use  at  least  30  experiment  vectors 
and  a  minimum  effective  sensor  spacing  of  45  pulse  repetition  intervals.  With  these 
values,  for  the  search  path  of  figure  4-1  and  for  a  pulse  repetition  interval  of  2 
seconds,  we  should  be  able  to  obtain  a  decent  estimate  of  the  acoustic  beacon's 
position  and  velocities. 

4.5  Summary 

From  the  results  of  the  Monte  Carlo  simulations  we  see  that  in  general,  as  the 
number  of  experiment  vectors  used  to  find  the  estimated  parameter  vector  0  increases, 
the  errors  of  the  estimated  parameters  and  the  variance  of  the  estimated  parameter 
vector  deceases.  This  implied  that  to  obtain  the  best  estimate  of  the  acoustic  beacon's 
location,  we  should  use  a  large  number  of  experiment  vectors,  with  a  large  effective 
sensor  spacing.  We  run  into  problems  with  this  is  approach  if  the  time  it  takes  to 
obtain  an  estimated  position  is  a  factor.  We  showed  that  for  the  search  path  given  in 
section  4.2  and  for  an  acoustic  beacon  with  a  pulse  repetition  interval  of  2  seconds,  we 
need  to  use  a  minimum  of  20  experiment  vectors  and  an  effective  sensor  spacing  of  35 
pulse  repetition  intervals  to  obtain  a  decent  estimate  when  using  the  stationary  acoustic 
beacon  algorithm.  We  also  showed  that  with  the  same  search  path  and  pulse  repetition 
interval,  we  need  to  use  a  minimum  of  30  experiment  vectors  and  an  effective  sensor 
spacing  of  45  pulse  repetition  intervals.  In  all  scenarios,  the  use  of  accurate 
navigational  equipment  to  measure  the  position  of  the  receiving  ship  is  critical  to 
obtain  an  accurate  estimate  of  the  acoustic  beacon's  location.  This  is  shown  by  the 
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better  estimates  obtained  from  using  Differential/P  code  GPS  errors  of  3  meters  rms. 
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Chapter  V 
Receiver  Design 

5.1  Introduction 

A  receiver  must  be  designed  to  implement  the  maximum  likelihood  estimation 
algorithms  described  in  chapters  II  and  III.  This  receiver  should  fulfill  the  goals  of 
being  an  inexpensive,  lightweight,  easily  transported  receiver  that  can  perform  all  of 
the  functions  of  an  older  chart  recorder.  To  determine  the  specifications  for  the 
receiver  hardware,  we  look  at  the  signal  that  is  received,  the  ambient  noise  that  is 
received,  the  thermal  noise  generated  by  the  receiver's  preamplifier,  and  the  required 
signal  output.  We  also  examine  the  characteristics  of  the  hydrophone  used  as  a 
receiving  sensor,  and  develop  a  practical  hydrophone  model  so  the  preamplifier's  input 
characteristics  can  be  determined. 

In  designing  a  receiver  to  implement  the  algorithms  described  in  chapters  II 
and  III,  we  make  the  following  general  assumptions.  We  assume  that  the  beacon 
signal  has  a  carrier  frequency  of  10,000  Hertz,  a  pulse  width  of  10  milliseconds,  and  a 
pulse  repetition  interval  of  2  second  This  is  similar  to  several  acoustic  beacons 
currently  in  use.  To  cut  costs,  a  Motorola  68HC11  microcontroller  will  be  used.  The 
68HC11  is  an  8-bit,  low  power  microcontroller  with  several  useful  peripheral 
functions  built  in.  These  peripheral  functions  include  an  eight  channel  8-bit  analog  to 
digital  (A/D)  converter,  an  asynchronous  serial  communications  interface,  five  general 
input/output  ports,  and  a  16-bit  free  running  timer  system  with  five  output  compare 
registers.  This  lets  us  use  a  single  chip  to  synchronize  the  time  of  receipt  tM  to  the 
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pulse  repetition  interval,  digitally  sample  the  received  signal,  control  the  receiver's 
gain,  and  communicate  with  the  interfacing  computer.  Another  factor  in  deciding  to 
use  the  68HC11  microcontroller  is  that  the  68HC11  and  it's  programming  support 
equipment  are  commonly  available.  For  the  receiving  sensor,  we  use  the  Benthos 
AQ-4  hydrophone  attached  to  100  meters  of  RG-58/u  coaxial  cable.  The  Benthos 
AQ-4  hydrophone  has  an  open  circuit  response  of  -201  dB  re  1  Volt  per  IpPa,  which 
is  representative  of  the  type  of  omnidirectional  hydrophones  currently  available. 

5.2  Design  Criterion 

The  signal  transmitted  by  the  acoustic  beacon  can  be  characterized  as  a 
sequence  of  gated  continuous  wave  pulses  at  a  carrier  frequency  fc.  We  depict  the 
beacon  signal  as: 


(5-1) 


where  w(t)  is  a  windowing  function  that  defines  the  pulse  width,  Tp  is  the  period 
which  defines  the  pulse  repetition  interval,  and  <J)  is  a  phase  term.  As  before,  the 
coefficient  T0  represents  the  unknown  absolute  time  reference. 

We  can  represent  the  signal  that  is  received  by  the  observer  as: 

m 

where  hx  represents  the  attenuation  the  signal  experiences  in  traveling  from  the  beacon 
to  the  observer,  and  Q  represents  a  random  phase  distortion  due  the  propagation  of 
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the  signal  through  the  ocean.  As  discussed  in  chapter  II,  the  term  t,M  represents  die 
synchronized  time  of  receipt  and  is  given  by: 

t  =  t  -  i-T  =  T.  +  T  (5-3) 

|t  *|i  P  M  o 

where  TR  is  the  acoustic  travel  time  of  the  beacon  signal.  The  term  n(t)  represents 
the  combination  of  the  ambient  noise  that  is  received  and  the  thermal  noise  that  is 
generated  by  the  receiver's  preamplifier. 

Since  we  use  range  differences  in  the  maximum  likelihood  estimation 
algorithms  of  chapters  II  and  III,  the  parameter  that  we  need  to  find  from  the  received 
signal  is  the  synchronized  time  of  receipt  t,,,.  In  order  to  find  t,M,  we  digitally  process 
the  received  signal.  To  determine  the  proper  sampling  rate,  we  must  look  at  the 
frequency  content  of  the  received  signal  and  the  desired  accuracy  of  the  synchronized 
time  of  receipt  t1(1.  If  we  apply  the  Nyquist  sampling  rate  theorem  directly  to  the 
received  signal,  the  sampling  rate  would  have  to  be  greater  then  twice  the  carrier 
frequency  For  carrier  frequencies  around  10,000  Hertz,  the  required  sampling  rate 
is  too  fast  for  the  68HC1 1  to  handle  both  the  data  collection  and  the  signal  processing. 
However,  from  looking  at  equation  (5-2),  we  notice  that  the  received  windowing 
function  w(t)  contains  the  parameter  t>(1.  Therefore,  if  we  remove  the  carrier  frequency 
and  just  look  at  the  envelope  of  the  received  signal  given  by  w(t),  we  can  still 
determine  the  synchronized  time  of  receipt  by  observing  when  the  signal's  envelope  is 
received.  To  remove  the  carrier  frequency  f„  we  use  a  precision  rectifying  circuit 
with  a  low  pass  filter  to  form  an  envelope  detector.  This  allows  us  sample  at  the 
reduced  rate  of  twice  the  bandwidth  of  the  signal's  envelope  given  by  w(t). 
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To  reduce  the  receiver's  overall  noise  level,  the  bandwidth  of  the  receiver 
should  match  the  bandwidth  of  the  envelope.  If  the  bandwidth  of  the  receiver 
increases  above  the  bandwidth  of  the  received  signal's  envelope,  out  of  band  noise 
from  the  oceanic  environment  and  other  interference  sources  enters  the  receiver, 
decreasing  the  signal  to  noise  ratio.  On  the  other  hand,  if  the  receiver's  bandwidth  is 
less  then  the  bandwidth  of  the  received  signal's  envelope,  we  do  not  allow  the  full 
bandwidth  of  the  envelope  to  pass  through  the  receiver,  which  again  lowers  the  signal 
to  noise  ratio.  The  windowing  function  w(t)  can  be  approximated  by  a  simple 
rectangular  window  with  a  duration  equal  to  the  pulse  width  of  the  signal.  The 
bandwidth  of  the  windowing  function  and  the  receiver  is  then  given  by: 


Bandwidth  = 


1 

Pulse  Width 


(5-4) 


For  a  pulse  width  of  10  milliseconds,  the  windowing  function’s  bandwidth  is  100 
Hertz.  With  a  bandwidth  of  100  Hertz,  the  sampling  frequency  must  then  be  at  least 
200  Hertz,  which  equates  to  a  sampling  interval  of  no  more  then  5  milliseconds. 

We  must  be  careful  not  to  sample  at  too  slow  a  rate,  otherwise  the  errors 
associated  with  the  quantization  of  the  time  base  will  cause  large  errors  in  the 
localization  algorithms.  To  determine  an  acceptable  quantization  step  size,  or 
equivalently,  how  much  error  can  we  tolerate  in  the  time  of  receipt  data,  we  need  to 
compare  the  quantization  errors  to  the  errors  in  measuring  the  observer's  location.  The 
source  of  error  in  measuring  the  observers  position  is  due  to  errors  in  the  GPS  position 
data.  For  a  C/A-code  GPS  receiver,  the  published  rms  errors  are  on  the  order  of  25 
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meters.  Using  a  simple  homogeneous,  direct  path  propagation  model  with  the  speed  of 
sound  in  water  equal  to  1500  meters  per  second,  a  signal  takes  16.667  milliseconds  to 
travel  25  meters.  We  call  this  the  equivalent  time  error  of  the  position  error.  We 
would  like  the  errors  associated  with  the  quantization  of  the  time  base  to  be  less  than 
the  equivalent  time  error  of  the  position  errors.  Assuming  no  other  errors  in  the  time 
of  receipt,  the  maximum  error  in  measuring  the  time  of  arrival  tI(J  is  half  the  sampling 
interval.  For  a  C/A  code  GPS  receiver  the  required  sampling  interval  of  5 
milliseconds  is  much  less  then  the  equivalent  time  error  of  the  position  error,  therefore 
the  quantization  errors  are  relatively  small  compared  to  the  errors  in  measuring  the 
observer's  position.  However,  because  more  accurate  navigational  equipment  will 
most  likely  be  available  in  the  near  future,  and  because  the  68HC1 1  has  the  required 
speed,  we  will  sample  the  received  signal's  envelope  every  1  millisecond.  With  a 
sampling  interval  of  1  millisecond,  as  long  as  the  rms  errors  of  the  navigational  system 
are  greater  than  1.5  meters,  the  quantization  errors  will  be  smaller  then  the  equivalent 
time  errors  of  the  position  errors. 

To  determine  the  synchronized  time  of  receipt  t1(J  from  the  sampled  envelope, 
we  pass  the  sampled  envelope  through  a  matched  filter  based  upon  w(t),  and  look  for 
the  time  that  corresponds  to  the  maximum  value  of  the  output  of  the  matched  filter. 

The  received  time  is  then  divided  modulo  the  pulse  repetition  interval  to  obtain  the 
synchronized  time  of  receipt.  The  use  of  a  matched  filter  has  two  benefits.  First,  the 
output  of  a  matched  filter  for  a  rectangular  input  signal  with  the  same  pulse  width  of 
w(t)  will  have  a  unique  maximum  peak  which  we  can  use  to  calculate  the  time  of 
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receipt.  Secondly,  a  matched  filter  produces  an  output  with  the  maximum  signal  to 
noise  ratio.  The  digital  form  of  a  matched  filter  for  a  rectangular  signal  has  the  form 
of  the  moving  average: 


y[*J  =  7777  E  (5_5) 

rv  +  i  j.0 

For  a  pulse  width  of  10  milliseconds  and  a  sampling  rate  of  1  millisecond,  N  is  equal 
to  10.  Figures  5-1  and  5-2  show  the  output  of  the  moving  average  matched  filter  for 
an  input  that  represents  the  sampled  envelope  of  the  received  signal  with  additive 
noise.  From  figure  5-2  we  see  that  it  is  relatively  easy  to  find  the  maximum  value  of 
the  output  of  the  matched  filter.  We  do  not  have  to  worry  about  the  phase  delay  of 
the  matched  filter  because  we  compare  the  time  of  arrival  of  two  signals  relative  to 
each  other.  Since  the  phase  delay  is  the  same  for  all  received  signals,  it  does  not 
effect  the  comparison  of  the  two  arrival  times. 
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°  Sampled  Envelope  with  Additive  Noise 
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Figure  5-1 
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0  10  20  30  40  50  60 

°  Output  of  Matched  Filter 


Figure  5-2 

The  receiver  should  be  able  to  detect  the  target's  beacon  signal  in  the  presence 
of  +he  additive  noise  term  n(t).  The  two  largest  contributors  of  noise  are  ambient 
oceanic  noise  and  thermal  noise  generated  by  the  receiver’s  preamplifier.  Ambient 
oceanic  noise,  due  to  factors  such  as  wind  force,  ships,  industrial  activity, 
precipitation,  biologies,  and  others,  is  received  by  the  hydrophone  which  generates  an 
equivalent  noise  voltage.  Using  the  hydrophone's  open  circuit  response 
characteristics,  the  receiver's  bandwidth,  and  empirical  data  of  noise  spectrum  levels 
summarized  by  Wenz  [Wenz  1962],  the  equivalent  noise  voltage  of  the  oceanic  noise 
can  be  calculated  using: 

.  jo^  •“’H  <«) 

where  Hw  is  the  hydrophones  open  circuit  response  in  dB  re  1  Volt  per  IpPa,  e0  is  the 
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ambient  oceanic  noise  in  dB  re  1  pPa,  and  BW  is  the  receiver's  bandwidth  in  Hertz. 
Table  5-1  shows  the  equivalent  noise  voltage  for  various  Sea  states  (Beaufort  Scale)  at 
10,000  Hertz  using  a  hydrophone  with  an  open  circuit  receiver  response  of  -201  dB  re 
1  Volt  per  1  pPa,  and  a  receiver  bandwidth  of  1 00  Hertz.  Ideally  the  noise  in  a 
receiver  should  be  dominated  by  external  noise  sources.  This  means  that  the  receiver's 
thermal  noise  should  be  less  then  the  ambient  oceanic  noise.  Since  sea  states  1  and  2 
are  not  common,  the  receiver's  thermal  noise  is  designed  to  be  less  then  the  ambient 
oceanic  noise  associated  with  sea  state  3.  This  requirement  limits  the  test  receiver's 
thermal  noise  reflected  at  the  input  of  the  preamplifier  to  be  less  then  89  nV/t/Hz. 


Sea  State 
(Beaufort  Scale) 

Ambient  Oceanic 
Noise 

(dB  re  ljiPa) 

Equivalent 
Noise  Voltage 
(nV/V  Hz) 

Total  Equivalent 
Noise  Voltage  e„ 
(pV) 

i 

48 

22 

0.22 

2 

56 

56 

0.56 

3 

60 

89 

0.89 

5 

68 

224 

2.24 

8 

73 

398 

3.98 

limit 

80 

891 

8.91 

Table  5-1 

Another  desirable  characteristic  of  the  receiver  is  that  it  should  have  as  large  a 
dynamic  resolution  as  possible.  A  large  dynamic  resolution  allows  the  receiver  to 
detect  a  broad  level  of  signal  amplitudes  for  a  set  gain.  Since  the  received  signal  will 
be  digitally  processed,  we  need  to  look  at  the  dynamic  resolution  of  the  A/D  converter. 
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The  dynamic  resolution  of  an  A/D  converter  is  given  by: 

Dynamic  Resolution  =  20  log10  ( 2*“ ) 
For  and  8  bit  A/D  converter,  the  dynamic  resolution  is  only 


(5-7) 


20  1ogIO(28)  =  48  dB  (5-8) 

This  is  not  quite  large  enough.  We  would  like  a  dynamic  resolution  that  is 
comparable  to  the  dynamic  resolution  of  the  older  paper  recorders.  This  means  we 
need  a  dynamic  resolution  of  at  least  60  dB.  To  increase  the  dynamic  resolution, 
either  a  higher  bit  A/D  converter  could  be  used,  or  a  logarithmic  compressor  can  be 
used  prior  to  digital  sampling.  Since  we  are  restricted  to  the  8  bit  A/D  converter  of 
the  68HC1 1,  a  logarithmic  compressor  will  be  used  to  increase  the  receiver's  dynamic 
resolution 

Using  a  logarithmic  compressor,  the  dynamic  resolution  is  given  by: 


Dynamic  Resolution 


20-log10 


(5-9) 


where  V„,  is  the  saturation  point  of  the  logarithmic  compressor  and  Vmtn  is  the 
minimum  detectable  signal  at  the  input  of  the  logarithmic  compressor.  Typically, 
logarithmic  compressors  require  an  input  signal  that  is  greater  then  2  mV.  Below  2 
mV,  the  input  current  to  the  logarithmic  compressor  becomes  comparable  to  the  bias 
current  of  the  matched  transistors  used  to  obtain  the  logarithmic  dependence,  and 
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subsequently  the  logarithmic  dependence  is  no  longer  valid  [Millman  1979].  For  the 
receiver  designed  in  section  5.4,  VMl  is  approximately  8  V  which  gives  a  dynamic 
resolution  of: 


Dynamic  Resolution  =  20  -log10|  j  =  72  dB  t5-10) 


To  determine  the  required  gain  of  the  receiver,  we  need  to  took  at  the  signal 
level  that  we  are  attempting  to  receive.  We  wish  to  be  able  to  detect  low  level  signals 
that  are  right  at  the  noise  floor  of  the  receiver.  This  requires  the  receiver  to  have 
enough  gain  to  detect  a  signal  at  the  equivalent  oceanic  noise  level  of  89  nV/^Hz. 
Since  a  logarithmic  compressor  is  used  just  prior  to  A/D  conversion,  the  required  gain 
is  determined  by  the  minimum  detectable  level  in  the  logarithmic  compressor  and  the 
oceanic  noise  level.  Jsing  the  ambient  oceanic  noise  and  the  input  requirements  of 
the  logarithmic  compressor  from  above,  the  maximum  required  gain  of  the  receiver  is 
given  by: 

A  =  2  -9~3  =  87  dB  (5-11) 

“  89  •  10'9 

However,  it  is  possible  that  the  received  signal  could  be  quite  a  bit  larger  then 
the  minimum  signal  level  for  a  strong  beacon  in  close  proximity  to  the  receiving  ship. 
For  example,  a  30  Watt  beacon  100  meters  from  the  receiving  hydrophone  will 
produce  an  input  signal  of  about  10  mV.  This  signal  would  completely  saturate  the 
receiver  if  the  gain  is  fixed  at  AVmtx.  To  prevent  the  receiver  from  saturating,  some 
form  of  feedback  gain  control  is  needed.  Using  one  of  the  output  ports  of  the  68HC 1 1 
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as  a  control  line,  simple  resistive  attenuators  can  be  switched  on  or  off  to  reduce  or 
increase  the  gain  of  the  receiver  based  upon  the  maximum  signal  level  at  the  A/D 
converter.  To  determine  how  much  attenuation  is  needed,  we  look  at  the  saturation 
point  of  the  preamplifier  and  the  maximum  likely  input  signal.  For  design  purposes, 
to  keep  a  10  mV  signal  from  saturating  the  receiver,  the  receiver's  minimum  gain  is 
given  by: 


— - - 58  dB 

KMO*3 


(5-12) 


Here  again  V„,  is  the  logarithmic  compressor's  saturation  level.  Since  the  input 
signal  level  will  be  somewhere  between  the  noise  floor  and  the  maximum  likely  input 
signal  most  of  the  time,  we  can  use  multiple  resistive  attenuator  networks  to  set  the 
receiver's  gain  to  any  level  in  between  AVnux  and  Ay,^.  For  this  design  we  will  use 
four  resistive  attenuator  networks  to  provide  attenuation  levels  of  -3  dB,  -9  dB, 

-12  dB,  -18  dB,  -24  dB,  and  -30  dB. 

53  Hydrophone  Model 

To  determine  the  input  characteristics  of  the  preamplifier,  the  hydrophone  and 
cable  must  be  modeled.  Figure  5-3  shows  an  equivalent  circuit  for  a  stiffness- 
controlled  piezoelectric  hydrophone.  Here  Rfc  is  the  hydrophone's  resistance,  Ch  is  the 
hydrophone's  capacitance,  e„  represents  the  equivalent  ambient  noise  of  the  ocean,  and 
e,^  represents  the  thermal  noise  of  the  hydrophone.  For  frequencies  considerably 
below  1 00  kHz,  the  ambient  noise  level  of  the  ocean  is  much  greater  then  the 
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hydrophone's  thermal  noise,  while  the  impedance  of  the  hydrophone  is  dominated  by 
the  capacitance  Ch.  This  allows  us  to  simplify  the  hydrophone  model  by  eliminating 
R*  and  e^  [Wilson  1985], 


Figure  5-3 

The  cable  assembly  can  be  modeled  as  a  two  conductor  transmission  line. 
Using  standard  RG-58/u  coaxial  cable  with  a  solid  copper  inner  conductor  and  a 
polyethylene  dielectric,  we  can  model  the  cable  as  a  series  resistance  R,.  and  a  shunt 
capacitance  Cc  [Cheng  1983],  Standard  RG-58/u  coaxial  cable  has  a  series  resistance 
of  33.31  Q  per  1,000  meters,  and  shunt  capacitance  of  70  pF  per  meter.  Combing  the 
simplified  hydrophone  model  and  the  cable  model,  we  have  the  circuit  of  figure  5-  4. 


Figure  5-4 
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Figure  S-4  can  be  simplified  to  give  the  equivalent  Thevinin  circuit  model: 


Figure  5-5 

The  source  impedance  Z,(/)  is  given  by: 


W) = 


2j  it  fRe  Ch  +  1 

[  V  *fRc  Ch  Cc  +  (Ck  +  Cc  )  ]  2J  */ 


(5-13) 


Figure  5-6  shows  a  plot  of  the  source  impedance  verses  frequency  for  the  Benthos 
AQ-4  hydrophone  with  Ch  specified  as  2,400  pF  ±25%.  To  prevent  serious  loading 
effects,  the  preamplifier's  input  impedance  must  be  considerably  larger  then  the  source 
impedance  given  by  equation  (5-13).  For  design  purposes,  the  magnitude  of  the 
source  impedance  at  10,000  Hertz  is  1,693  Q,  therefore  we  choose  the  preamplifier's 
input  impedance  to  be  at  a  minimum  of  20  time  the  source  impedance,  or  33.8  kQ. 
This  will  keep  the  loss  due  to  loading  below  0.5  dB. 


127 


Source  Impedance  Magnitude  vs  Frequency  in  Hz 

Figure  5-6 

5.4  Test  Receiver  Hardware  Design 

Based  on  these  design  criteria,  a  receiver  was  built  for  testing.  This  section 
discuses  the  circuit  design  considerations  and  implementation  of  this  test  receiver. 
Figure  7  shows  the  general  signal  flow  of  the  receiver  starting  with  the  preamplifier 
and  moving  to  the  68HC1 1  microcontroller.  An  important  theme  of  the  receiver 
design  is  to  avoid  exotic  components  to  minimize  the  cost  of  the  receiver. 

5.4.1  Preamplifier 

Refer  to  the  preamplifier  schematic  diagrams  in  Appendix  1  for  the  following 
description.  The  first  stage  of  the  preamplifier  is  a  tuned  N  channel  junction  field 
effect  transistor  (JFET)  common-source  amplifier.  To  help  keep  low  frequency 
ambient  oceanic  noise  from  entering  the  preamplifier,  C01  and  R*,,  form  a  high  pass 
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Figure  5-7 


filter  with  a  cutoff  frequency  given  by: 


Sc- 


1 


2  tt  /?oj  C, 


(5-14) 


01 


To  eliminate  as  much  low  frequency  oceanic  noise  as  possible  but  still  allow  for  small 
changes  in  the  acoustic  beacon's  carrier  frequency,  we  chose  the  high  pass  filter  cut  off 
frequency  as  7000  Hertz.  The  preamplifier's  input  impedance  is  determined  by  R*,, 
since  the  input  impedance  of  the  JFET  is  so  large  (  >10M  Q  ).  To  prevent  loading 
between  the  hydrophone  source  and  the  preamplifier  we  must  ensure  Rq,  is  larger  then 
33.8  kfX  To  ensure  that  the  thermal  noise  of  the  preamplifier  is  less  then  equivalent 
oceanic  noise  of  sea  state  3,  R^  must  be  chosen  such  that  the  thermal  noise  of  the 
parallel  combination  of  R^  and  source  impedance  Z,(/)  is  considerably  less  then 
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89  nV/V^Hz.  The  thermal  noise  of  a  resistor  is  given  by: 


eK=  yJAktRB  (5-15) 

where  k  is  Boltzmann's  constant,  t  is  the  absolute  temperature  in  Kelvin,  B  is  die 
bandwidth  in  Hertz,  and  R  is  the  resistance  in  Ohms  [Horowitz  and  Hill  1989].  For 
the  Benthos  AQ-4  hydrophone  at  a  frequency  of  10,000  Hertz  Z ,(/)  is  approximately 
1700  ft  Asa  result,  the  parallel  combination  of  Rg,  and  Z,(/)  will  be  close  to  the 
value  of  Z,(/)  for  Rg,  greater  then  32  kft  and  the  associated  thermal  noise  will  be 
well  below  89  nV/^Hz.  However,  it  would  be  nice  to  ensure  that  the  thermal  noise  of 
the  preamplifier  is  much  less  then  equivalent  oceanic  noise  of  sea  state  3  for  any 
source  impedance.  To  ensure  this,  we  choose  Rg,  such  that  its  thermal  noise  is 
approximately  45  nV/^Hz.  To  meet  the  noise  constraint,  the  loading  constraint,  and 
the  cut  off  frequency  constra;n  of  equation  (14),  we  choose  Rg,  as  120  kft  and  C0,  as 
180  pF. 

The  gain  of  the  first  stage  JFET  common-source  amplifier  is  given  by: 

A,(f)  =  ~VZg(/)''’‘l  <5-l«) 

v‘  ZDU)*'d 

where  Yft  is  the  JFETs  forward  transconductance,  rd  is  the  JFETs  intrinsic  drain 
resistance,  and  2^(  / )  is  given  by: 


W)  = 


(M?  + 


2j*f 
Cm 
2 /*/ 
^02^08 


^C{ 


02 


(5-17) 
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Z D(/)  represents  the  complex  impedance  of  the  combination  of  L01,  R^,  and  C02.  The 
use  of  the  reactive  load  Z D(/)  allows  us  to  obtain  the  narrow  bandwidth  required  by 
equation  (5-4).  The  gain  of  the  first  stage  will  be  greatest  when  the  frequency  of  die 
input  signal  is  at  the  resonant  frequency  of  ZD(/ ).  The  resonant  frequency  of  ZD(/ ) 
is  given  by: 


fr  = 


1 


(5-18) 


2  *  \j  ^oi  ^02 

We  want  the  preamplifier  to  have  it's  maximum  gain  at  the  acoustic  beacon's  carrier 
frequency,  therefore  we  choose  L01  and  C02  such  that  the  resonant  frequency  equals  the 
acoustic  beacon's  carrier  frequency  .  In  the  test  receiver,  Q01  is  an  E230  general 
purpose  N  channel  JFET.  The  E230  has  a  nominal  forward  transconductance  of 
1.5-10 3  Siemens  and  a  nominal  intrinsic  drain  resistance  of  12.5  k£l  Using  equations 
(5-16)  and  (5-17),  and  the  values  from  Appendix  1,  at  a  beacon  frequency  of  10,000 
Hz,  AVI  is  approximately  24  dB. 

In  general,  the  output  impedance  of  an  R-L-C  tuned  amplifier  is  quite  high, 
therefore,  a  JFET  source  follower  is  used  as  a  buffer  immediately  following  the  first 
stage.  Resistor  R^  and  capacitor  CM  form  a  high  pass  filter  similar  to  R^,  and  C0I, 
and  serve  to  capacitively  couple  the  JFET  source  follower  to  the  tuned  JFET  amplifier. 
The  cut  off  frequency  of  the  high  pass  filter  formed  by  R^  and  Cw  is  given  by 
equation  (5-14)  with  R^  substituted  for  R,,,  and  Cw  substituted  for  C0I.  To  prevent 
loading  between  the  JFET  amplifier  and  the  JFET  buffer,  R^  must  be  significantly 
larger  then  the  output  impedance  of  the  JFET  amplifier.  However,  we  must  be  careful 
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in  choosing  so  that  its  thermal  noise,  when  reflected  back  to  the  input  of  the  first 
stage,  is  less  then  89  nV/)/  Hz.  Using  equation  (15),  this  limits  to  560  kfl 

To  enhance  the  performance  of  the  JFET  source  follower,  Q0J  and  R^  are 
added  as  a  bootstrapped  load.  Because  the  base-emitter  voltage  of  Q03  is 
approximately  constant,  the  combination  of  Rqj  and  Q03  cause  a  constant  source  current 
to  flow  through  JFET  Q02.  This  makes  Q02's  VGS  approximately  constant,  which  in 
return  reduces  nonlinearities  [Horowitz  and  Hill  1989].  This  is  beneficial  because  the 
signal  level  at  this  point  in  the  preamplifier  is  still  quite  small. 

The  first  stage  of  the  preamplifier  is  powered  by  a  separate  5  Volt  3-terminal 
7805  voltage  regulator.  We  do  this  to  isolate  the  first  stage  from  subsequent  stages, 
which  prevents  the  feedback  of  any  noise  generated  by  subsequent  stages  along  the 
main  power  supply  line.  This  provides  Q0,  with  a  clean,  stable  supply  voltage  which 
is  critical  when  working  with  very  low  level  input  signals. 

The  second  stage  of  the  preamplifier  is  another  tuned  amplifier,  this  time  using 
a  PNP  bipolar  transistor.  Capacitor  C05  combined  with  the  parallel  combination  of  the 
bias  resistors  R^  and  R^  form  another  high  pass  filter  while  also  serving  to 
capacitively  couple  the  JFET  source  follower  from  the  first  stage  to  the  second  stage. 
The  cutoff  frequency  of  the  high  pass  filter  formed  by  C05,  R„7  and  Rog  is  given  by: 


1 


2it  -C,* 


*Q7-*o» 

^>7+*oe 


(5-19) 
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For  this  stage,  we  set  the  high  pass  filter's  cut  off  frequency  at  3000  Hertz.  The  gain 
of  the  second  stage  is  given  by: 


where 


(5-20) 


*.</>  - 


2 M 

^07 

2j*f 

^11  ^07 


+  _ 1 

An  C<77 


(5-21) 


As  in  the  first  stage  we  set  the  resonant  frequency  of  Ze(/)  given  by: 

’■  ■  wfes 

to  the  acoustic  beacon's  carrier  frequency.  Using  equations  (5-20)  and  (5-21)  for  a 
beacon  frequency  of  10,000  Hertz,  AV2  is  approximately  31  db. 

Following  the  PNP  timed  amplifier,  a  simple  JFET  source  follower  is  used  as  a 
buffer.  Capacitor  Cog  and  resistor  RI2  form  yet  another  high  pass  filter  while  also 
capacitively  coupling  the  output  of  the  PNP  amplifier  to  the  input  to  the  JFET 
follower.  The  cut  off  frequency  of  the  high  pass  filter  formed  by  Cog  and  R12  is  given 
by  equation  (14)  with  Cog  substituted  for  C0I  and  R12  substituted  for  R0„and  is  set  to 
3,000  Hertz. 

Similar  to  the  first  stage,  the  second  gain  stage  is  powered  by  a  separate  5 
Volt,  3-terminal  7805  voltage  regulator.  Again  we  do  this  to  prevent  noise  from  being 
feedback  along  the  power  supply  lines. 
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At  the  end  of  the  second  stage  of  the  preamplifier  the  maximum  gain  at  the 
acoustic  beacon's  carrier  frequency  is  approximately  55  dB.  We  are  under  the 
minimum  required  gain  of  58  dB,  therefore  we  should  not  have  to  worry  about  the 
first  two  stages  of  the  preamplifier  saturating  the  logarithmic  compressor.  However, 
we  still  need  an  additional  32  dB  of  gain  to  reach  the  required  maximum  gain  of  87 
dB.  Prior  to  the  next  gain  stage,  we  include  an  attenuation  network  to  prevent 
subsequent  stages  from  saturating. 

Following  the  JFET  source  follower  Qo5.  Ru  in  combination  with  shunt 
resistors  R1S,  R16,  R17,  and  RIg  form  a  variable  attenuation  network  which  is  controlled 
by  the  68HC11  microcontroller.  To  reduce  the  gain  of  the  preamplifier,  any 
combination  of  R15  through  R18  can  be  switched  to  ground  through  two  CD4053 
analog  switches.  Once  grounded,  the  shunt  resistors  form  a  voltage  divider  with  RM, 
and  subsequently  attenuate  the  signal.  Following  the  shunt  resistors  is  a  simple 
common  emitter  amplifier  that  provides  the  final  gain  necessary  to  obtain  a  maximum 
of  87  dB.  The  gain  of  this  stage,  including  the  effects  of  the  attenuator  network  is 
given  by: 


Av  = 


_^2i 
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2  nfRsC09  • 
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•  2  Ji/Cqj  +  Rt+  /?14 


U  *19 +  *20  /  *  *19 +  *20  ‘I 

where  R,  is  the  parallel  combination  of  any  shunt  resistors  R15  through  Rlg  that  are 
switched  to  ground.  If  none  of  the  shunt  resistors  are  switched  to  ground,  R,  is  very 
large  and  AV3  approaches: 
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In  this  case  the  gain  of  the  preamplifier  is  at  its  maximum  of  approximately  89  dB.  In 
actuality,  the  maximum  gain  will  be  slightly  less  then  89  dB  due  to  small  losses 
caused  by  loading  between  the  different  stages.  If  all  of  the  shunt  resistors  are 
switched  to  ground,  R,  is  at  its  minimum  value  and  the  gain  of  the  preamplifier  is 
approximately  56  dB.  Table  5-2  summarizes  which  shunt  resistors  are  switched  to 
ground  to  obtain  different  levels  of  attenuation. 


Attenuation  Level 

Shunt  Resistors  Switched  to  Ground 

0  dB 

none 

-3  dB 

R.5 

I  -9  dB 

R.« 

|  -12  dB 

R|j  and  RI6 

-18  dB 

R,7 

-24  dB 

R„ 

-30  dB 

Rl5*  Rl6>  Rl7>  RlS 

Table  5-2 

5.4.2  Envelope  Detector  Circuit 

Refer  to  the  Envelope  Detector  schematic  diagram  in  Appendix  1  for  the 
following  description.  After  the  preamplifier,  the  received  signal  passes  through  a 
unity  gain  buffer.  This  isolates  the  preamplifier  from  the  envelope  detector,  and  also 
provides  the  low  source  impedance  that  the  precision  rectifier  circuit  needs  to  function 
properly.  U07,  Q07,  Q0„  and  the  low  pass  filter  combination  of  C2J  and  R3,  are  the 
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heart  of  the  envelope  detector.  Diode  Dol  protects  U07  during  large  input  swings  above 
the  reference  voltage  VREF.  Resistors  and  R30  add  bias  stability  to  transistors  Q07 
and  Qog. 

As  the  input  signal  at  the  inverting  terminal  of  U07  goes  below  the  reference 
voltage  at  the  noninverting  terminal  of  U07,  Q07  is  brought  into  the  active  region, 
thereby  drawing  Qog  into  the  active  region  which  charges  capacitor  C2J.  As  the 
difference  between  the  reference  voltage  and  the  input  signal  becomes  greater,  Q07  and 
Qog  are  brought  further  into  the  active  region  which  in  turn  increases  the  time  that 
capacitor  C25  charges.  When  the  signal  at  the  inverting  terminal  of  U07  is  above  the 
reference  voltage  at  the  noninverting  terminal  of  U07,  transistor  Q07,  and  subsequently 
Qog  are  cut  off.  The  charge  in  capacitor  C2S  is  then  discharged  through  resistor  R31. 

As  long  as  the  time  constant  formed  by  the  combination  of  C25  and  R3,  is  much 
greater  then  the  period  of  the  input  signal's  carrier  frequency,  the  output  taken  at  C2J 
will  be  the  envelope  of  the  input  signal.  To  ensure  operation  with  very  low  level 
inputs,  Uog  is  chosen  to  have  a  large  gain  bandwidth  product  and  a  fast  slew  rate. 

5.4.3  Logarithmic  Compressor 

Refer  to  the  Logarithmic  Compressor  schematic  diagram  in  Appendix  1  for  the 
following  description.  Prior  to  logarithmic  compression,  we  pass  the  received 
envelope  through  a  noninverting  amplifier  with  a  gain  of  9  dB  to  restore  the  signal 
level  that  was  lost  in  the  envelope  detector.  To  obtain  an  output  that  is  proportional 
the  logarithm  of  the  input,  we  rely  on  the  logarithmic  relation  between  transistor  Q^'s 
voltage  and  current.  By  using  Q<)9  in  U^'s  feedback  loop,  the  output  of  the  logarithmic 
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compressor  is  given  by: 


•  Vln| 

40) 

{  *«J 

I  1 

(5- 25) 


where  VT  is  given  by: 


Y  -  temperature  (5_26) 

r  11600 

Here  the  temperature  is  in  Kelvin.  For  room  temperature,  VT  is  approximately  0.0259. 
From  equation  (5-25)  we  note  that  for  small  input  signals,  the  output  V„  is  large,  and 
for  large  input  signals,  the  output  V0  is  small.  To  set  the  zero  crossing  point  of  the 
logarithmic  compressor,  we  choose  R40  such  that: 


(5-27) 


With  R3s  equal  to  10  kO,  V+  equal  to  10  Volts,  and  VMt  equal  to  8  Volts,  R40  is 
approximately  12.5  kQ.  VMt  represents  the  largest  possible  input  to  the  logarithmic 
compressor.  To  set  the  maximum  output  level  of  the  logarithmic  compressor,  we 
chose  R42  and  R«  such  that  the  minimum  input  signal  of  2  mV  produces  an  output  of 
5  volts.  This  allows  us  to  digitally  sample  the  output  of  the  logarithmic  compressor 
directly,  without  worrying  about  damaging  the  68HC1  l's  A/D  converter.  The  use  of 
the  matched  transistor  Qq,  helps  stabilize  the  temperature  dependence  of  VT,  and  is 
essential  to  eliminate  the  dependence  upon  the  reverse  saturation  current  /„  which 
doubles  for  every  10°  C  rise  in  temperature  [Millman  1979]. 

By  taking  the  saturation  level  of  the  receivers  as  approximately  8  volts,  the 
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dynamic  resolution  of  the  receiver  is  approximately: 

Dynamic  Resolution  -  20  =  ^  (5-28) 

To  obtain  the  full  dynamic  resolution  at  the  input  to  the  A/D  converter,  the  output  of 
operational  amplifier  U,„  must  be  capable  of  going  between  zero  and  five  volts.  We 
would  like  to  restrict  the  output  of  U10  to  be  strictly  less  then  5.5  Volts  to  prevent 
damage  to  the  68HC1  l's  A/D  converter  in  case  of  a  failure  in  the  logarithmic 
compressor.  To  accomplish  this,  we  step  down  the  main  positive  supply  voltage  to  5.6 
volts  using  a  zener  diode  reference.  The  maximum  output  of  the  CA3130  operational 
amplifier  used  for  U,0  is  about  0.5  volts  below  the  positive  supply  voltage,  therefore 
the  output  of  U10  is  restricted  between  0  and  5.1  volts. 

5.4.4  68HC11  Microcontroller 

Refer  to  the  68HC11  Microcontroller  schematic  diagram  in  Appendix  1  for  the 
following  description.  The  68HC11  is  run  in  expanded  mode  at  a  clock  speed  of 
8  MHz.  Input/Output  ports  B  and  C  are  used  to  interface  to  the  external  27HC64 
EPROM  and  the  62HC64  RAM  chips.  A  74HC373  multiplexer  and  a  74HC00  NAND 
GATE  are  used  to  form  the  proper  address  line  controls  and  to  transfer  data  to  the 
external  memory  chips.  Port  PEO  is  used  for  the  input  to  the  A/D  converter.  The 
logarithmically  compressed  signal  passes  through  a  low  pass  filter  to  remove  any  high 
frequency  noise,  and  then  is  sequentially  sampled  by  die  A/D  converter.  Ports  PDO 
and  PD1  are  used  for  serial  data  output.  A  SCL/U  20  mA  SAIL-to-low-power-logic 
converter  is  used  to  convert  the  68HC1  l's  serial  data  to  the  SAIL  communication 
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protocol.  The  use  of  the  SAIL  communications  protocol  is  beneficial  because  of  it's 
simplicity,  and  it's  ability  to  communicate  with  multiple  nodes.  The  rest  of  port  D's 
output  lines  are  tied  to  the  positive  supply  through  100  kQ  pull  up  resistors  to  prevent 
the  output  lines  from  floating.  Ports  PA3,  PA4,  PA5,  and  PA7  are  used  to  control  the 
two  CD40S3  2  channel  analog  switches  which  control  the  attenuator  network  described 
earlier.  The  rest  of  port  A's  input/output  lines,  except  PAO,  are  tied  to  ground  through 
100  kQ  resistors  to  prevent  the  outputs  from  floating.  PAO  is  left  as  an  external  input 
for  further  development,  and  is  tied  to  the  positive  supply  through  a  100  kQ  pull  up 
resistor. 

Appendix  2  contains  a  listing  of  the  program  that  the  68HC1 1  executes. 

5.4.5  Power  Supply 

In  the  test  receiver,  a  +10  volt  power  supply  is  used  to  power  the  preamplifier, 
the  envelope  detector,  and  the  logarithmic  compressor.  A  secondary  +5  volt  power 
supply  is  used  to  power  the  68HC1 1  microcontroller.  The  use  of  a  separate  power 
supply  for  the  microcontroller  prevents  high  frequency  noise  generated  by  the  digital 
components  from  entering  the  preamplifier.  For  the  -5  V  that  is  required  by  the 
logarithmic  compressor,  a  third  supply  is  used.  This  provides  a  better  regulated 
negative  supply  then  using  a  DC  to  DC  voltage  converter  such  as  the  ICL  7660  to 
generate  the  required  -5  V.  Finally,  a  +12  volt,  300  mA  supply  is  provided  to  power 
an  external  GPS  receiver.  All  four  power  supplies  are  built  on  a  common  circuit 
board  and  share  a  common  ground  bus.  Refer  to  the  Power  Supply  schematic  diagram 
in  Appendix  1  for  the  following  circuit  description. 
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The  test  receiver  uses  a  standard  power  cord  to  connect  to  external  power  with 
a  one  half  amp  slow-blow  fuse  to  protect  the  receiver  in  case  of  a  short  circuit.  A 
Magnetek  Triad  F-93X  transformer  is  used  to  step  down  the  input  voltage.  Diodes  D0, 
through  Dm  act  as  a  standard  full  wave  bridge  rectifier.  Voltage  regulator  U0,  is  a 
simple  three  terminal  +12  volt  regulator  used  to  provide  power  to  the  external  GPS 
receiver.  Capacitor  C0I  filters  the  rectified  supply  voltage  to  provide  an  unregulated 
DC  voltage  to  U0].  Capacitors  C02  and  C03  are  bypass  capacitors  used  to  reduce  noise 
on  U0,'s  input  and  output  leads.  Because  of  the  high  current  requirements  of  the 
voltage  regulator,  U0,  is  mounted  to  the  chassis  bottom  for  heat  sinking. 

Voltage  regulator  U02  is  an  adjustable  four  terminal  voltage  regulator  used  to 
provide  the  +10  volts  required  by  the  preamplifier,  absolute  value  circuit,  and  the 
logarithmic  compressor.  Resistor  R^,  and  capacitor  C^  form  a  low  pass  filter  which 
helps  reduce  high  frequency  feedback  from  the  GPS  receiver  power  supply  (U0I).  Ro, 
also  acts  as  an  attenuator,  reducing  the  unregulated  DC  input  voltage  to  regulator  U02. 
By  doing  this,  the  power  that  U02  has  to  sink  is  reduced,  increasing  U02's  efficiency. 
Resistors  R^,  R^,  and  R^  form  the  feedback  network  used  by  U02  to  set  the  output 
voltage.  By  using  an  adjustable  voltage  regulator,  the  positive  supply  voltage  can  be 
set  more  precisely,  which  is  needed  to  maintain  sensitive  bias  points  in  the  logarithmic 
compressor.  Capacitors  C05  and  C^  are  bypass  capacitors  similar  to  C02  and  C03. 

Voltage  regulator  U03  is  a  simple  three  terminal  regulator  used  to  supply  the  +5 
volts  required  by  the  68HC11  and  support  systems.  Resistor  R<,5  and  capacitor  C07 
form  another  low  pass  filter  which  helps  isolate  the  preamplifier  from  the  68HC1 1 
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microcontroller.  As  with  R^,,  R^  reduces  the  unregulated  DC  voltage  at  the  input  of 
U0„  reducing  the  power  that  U03  must  sink.  Capacitors  CM  and  C^  are  bypass 
capacitors  similar  to  C02  and  C03.  The  combination  of  resistor  and  LED  Dos  are 
used  as  a  power  indicator,  with  Dos  mounted  on  the  front  panel  of  the  chassis  next  to 
the  power  switch. 

Finally,  voltage  regulator  UM  is  a  four  terminal,  adjustable  negative  voltage 
regulator  that  is  used  to  provide  the  -5  volts  required  for  the  logarithmic  compressor. 
Resistor  R07  and  capacitor  C10  form  a  low  pass  filter  which  converts  the  rectified  input 
voltage  to  unregulated  DC.  Resistors  R^,  R^,  and  Rl0  form  the  feedback  network 
used  by  to  set  the  output  voltage  at  -5  volts.  As  before,  Cu  and  C,2  are  bypass 
capacitors  that  help  reduce  noise  the  voltage  regulator's  input  and  output  lines. 

5.5  Test  Receiver  Performance 

To  test  the  validity  of  the  receiver  designed  in  section  5.4,  experiments  were 
conducted  to  measure  the  actual  performance  of  the  preamplifier,  envelope  detector, 
and  logarithmic  compressor. 

5.5.1  Preamplifier  Performance 

To  test  the  performance  of  the  preamplifier,  experiments  were  conducted  to 
measure  the  preamplifier's  actual  gain,  bandwidth,  and  thermal  noise.  To  measure  the 
gain  and  bandwidth  of  the  preamplifier,  the  output  of  the  preamplifier  was  measured 
for  sinusoidal  inputs  at  different  frequencies.  The  results,  along  with  the  predicted 
values  are  plotted  in  figure  5-8.  From  figure  5-8  we  see  that  the  actual  gain  of  the 
preamplifier  at  the  acoustic  beacon's  carrier  frequency  is  86  dB.  This  is  close  enough 
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—  Predicted  Gain 

Actual  Gain  (dB)  vs  Frequency  (Hz) 

Figure  5-8 

to  the  design  goal  to  be  acceptable.  The  loss  in  gain  compared  to  the  predicted  gain  is 
due  to  the  effects  of  loading  between  the  various  stages  and  to  deviations  from  the 
nominal  values  of  Yfj  and  rd.  We  also  note  that  die  actual  bandwidth  is  120  Hz  which 
is  slightly  larger  then  the  predicted  bandwidth.  This  increase  is  due  to  deviations  of 
Rq2  and  Ru  from  their  nominal  values  and  is  not  significant. 

To  determine  the  actual  thermal  noise  of  the  preamplifier,  we  short  the 
preamplifier's  input  and  measure  the  root  mean  square  output  using  a  digital 
multimeter.  Assuming  the  preamplifier's  noise  is  normally  distributed,  we  correct  die 
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output  measurement  to  reflect  a  normal  distribution  by  multiplying  by  1.13  [Horowitz 
and  Hill  1989],  The  preamplifier's  thermal  noise  is  then  found  by  using: 


1.13-e, 

*  Avjm 


(5-29) 


where  e,  is  the  measured  output  voltage,  Av  is  the  total  gain  of  the  preamplifier,  and 
BW  is  the  bandwidth  of  the  preamplifier.  Using  this  approach,  e,  was  measured  as 
6.8  millivolts.  The  preamplifier's  thermal  noise  is  then: 


B  1:13  j-8 ■lOi3  «  31  nVijHi 
19275^120 


(5-30) 


To  check  this  value  we  can  observe  the  output  of  the  preamplifier  (with  the  input 
grounded)  on  an  oscilloscope.  To  measure  the  preamplifier's  noise,  we  take  the  peak 
value  observed  on  the  oscilloscope.  Next  we  calculate  die  preamplifier's  thermal  noise 
using: 


e  = 

"  AvjBW 


(5-31) 


This  gives  a  rough  approximation  of  the  thermal  noise  of  the  preamplifier.  Vp.*  was 
measured  as  35  mV.  Using  equation  (5-31),  die  thermal  noise  of  the  preamplifier  is 
roughly  28  nV/^Hz.  This  value  is  of  the  same  order  of  magnitude  as  found  in 
equation  (5-30),  so  we  can  assume  the  noise  figure  given  in  equation  (5-30)  is  correct. 
5.5.2  Envelope  Detector 

To  test  the  performance  of  the  envelope  detector  we  look  at  the  output  for 


different  amplitudes  of  a  sinusoidal  input.  Figure  5-9  shows  the  measured  output  of 
the  envelope  detector  for  different  amplitudes  of  a  10,000  Hertz  sinusoid  input. 


Measured  Output  (Volts)  vs  Input  (Volts) 

Predicted  Linear  Relation 

Figure  5-9 

Ideally,  the  envelope  detector  should  have  an  output  that  is  linearly  dependent  on  the 
amplitude  of  the  input  sinusoid.  This  allows  the  envelope  detector  to  accurately  track 
the  true  envelope  of  the  beacon  signal.  From  figure  5-9  we  see  that  the  measured 
output  is  nearly  linear,  therefore  we  expect  the  envelope  detector  to  work  properly. 
55J  Logarithmic  Compressor 

To  test  the  performance  of  the  logarithmic  compressor,  we  look  at  the  output 
for  different  DC  voltage  inputs.  Figure  5-10  shows  the  measured  output  values  and 
the  predicted  values. 
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Measured  Output  (Volts)  vs  Input  (Volts) 

Predicted  Output 

Figure  5-10 

From  figure  10  we  see  that  the  logarithmic  compressor  does  not  follow  an  exact, 
logarithmic  relation.  However,  since  the  output  of  die  logarithmic  compressor 
monotonically  decreases  throughout  the  full  range  of  input  values,  die  compressor  is 
sufficiently  logarithmic  to  achieve  the  dynamic  resolution  of  equation  (5-28).  Since 
we  achieve  the  desired  dynamic  resolution,  the  performance  of  die  logarithmic 
compressor  is  acceptable. 

5.6  Conclusions 

In  this  chapter  a  receiver  to  implement  die  maximum  likelihood  estimation 
algorithms  developed  in  chapter  n  and  III  was  designed  and  tested.  Appendix  1 
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contains  the  schematic  diagrams  of  the  receiver  built  for  testing.  From  the  tests 
conducted,  we  see  that  the  test  receiver  meets  the  design  criteria  developed  in  section 
5.2.  To  complete  the  receiver,  an  Apple  Macintosh  personal  computer  is  used  for  the 
final  signal  processing  and  for  data  display.  Appendix  3  contains  a  listing  of  the 
source  code  used  by  the  Macintosh  for  signal  processing  and  for  displaying  the 
collected  data. 
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Chapter  VI 
Conclusion 

6.1  Observations  and  Summary 

In  this  diesis,  a  method  to  passively  localize  stationary  and  linearly  moving 
acoustic  beacons  was  developed.  Because  of  the  nonlinearities  of  die  structural  model 
glw,,,  0),  and  the  errors  in  the  measurements  x^,  yM,  and  t,M>  the  localization  problem 
was  formulated  as  a  constrained  maximum  likelihood  estimation  problem.  To  solve 
for  the  maximum  likelihood  estimate,  a  vector  of  Lagrange  multipliers  was  introduced 
and  a  Lagrangian  function  A  formed.  The  maximum  likelihood  estimate  was  then 
found  at  the  stationary  point  of  the  Lagrangian  function.  Figures  2-4  and  3-1 
summarize  the  algorithms  used  to  solve  for  the  maximum  likelihood  estimate  of  the 
acoustic  beacon's  position.  Both  algorithms  require  that  die  user  specify  the  maximum 
range  and  depth  of  the  search  area,  and  an  initial  guess  of  die  acoustic  beacon's 
location.  For  the  case  of  the  moving  beacon,  die  user  must  also  specify  the  maximum 
allowed  velocity  of  the  acoustic  beacon. 

Monte  Carlo  simulations  were  conducted  for  several  different  positions  and 
velocities  of  the  acoustic  beacon.  It  was  assumed  that  the  receiving  ship  followed  a 
hexagonal  search  path  with  legs  of  1000  meters.  In  practice,  the  actual  search  path  is 
not  critical  as  long  as  it  is  not  linear.  In  chapter  IV  results  from  six  scenarios  were 
presented.  Overall,  the  algorithms  developed  in  chapters  II  and  III  performed  well  for 
these  scenarios.  For  a  stationary  acoustic  beacon,  good  estimates  of  the  acoustic 
beacon's  location  were  obtain  using  GPS  errors  of  3  meters  and  25  meters  rms.  For 
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the  moving  acoustic  beacon,  a  good  estimate  of  the  acoustic  beacon's  location  was 
obtained  when  using  GPS  errors  of  3  meters  rms.  However,  the  accuracy  of  the 
algorithm  used  to  estimate  the  moving  acoustic  beacon's  location  degrades  for  GPS 
errors  of  25  meters  rms  unless  a  large  number  of  experiment  vectors  are  used,  or  a 
large  effective  sensor  spacing  is  used. 

From  the  results  of  the  Monte  Carlo  simulations,  it  was  shown  that,  in  general, 
as  the  number  of  experiment  vectors  (wM)  used  in  the  maximum  likelihood  estimation 
problem  increased,  or  the  effective  sensor  spacing  increased,  the  accuracy  of  the 
estimated  beacon  location  improved.  It  was  also  shown  that  the  accuracy  of  the 
estimated  beacon  location  improved  if  the  receiving  ship  passed  through  a  closest  point 
of  approach  to  the  acoustic  beacon.  In  all  cases,  the  accuracy  of  the  estimated  beacon 
position  was  significantly  better  when  using  3  meter  GPS  errors.  This  shows  that  to 
obtain  a  better  estimate  of  the  acoustic  beacon's  location,  the  position  of  the  receiving 
ship  must  be  measured  accurately. 

For  all  scenarios,  the  variance  of  the  estimated  beacon  position  and  velocity 
decreased  as  the  number  of  experiment  vectors  used  increased,  or  the  effective  sensor 
spacing  increased.  It  was  found  that  the  variance  of  the  moving  beacon's  estimated 
position  was  much  greater  then  the  variance  of  the  stationary  beacon's  estimated 
position.  This  is  due  the  manner  in  which  the  acoustic  beacon's  initial  position  and 
velocity  are  combined  in  the  modified  structural  model.  In  the  modified  structural 
model  given  by  equation  3-10,  the  individual  velocity  components  are  added  to  the 
initial  beacon  coordinates  x0,  y0,  and  to  find  the  location  of  the  acoustic  beacon 
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when  it  transmits  a  signal.  As  a  result,  the  algorithm  estimates  the  value  of  the  sum  of 
the  initial  position  coordinates  and  the  velocities  better  then  the  individual  components. 
Consequently,  the  algorithm  can  not  discern  between  small  perturbations  in  the 
estimated  position  coordinates  and  the  estimated  velocities. 

From  these  results,  to  obtain  the  best  possible  estimate  of  the  acoustic  beacon's 
position  a  large  number  of  experiment  vectors  with  a  large  effective  sensor  spacing 
must  be  used.  However,  the  time  required  to  collect  the  measurement  vectors 
increases  with  both  the  number  of  experiment  vectors  and  the  effective  sensor  spacing. 
If  the  time  it  takes  to  obtain  an  estimate  of  the  acoustic  beacon's  position  is  an  issue, 
fewer  experiment  vectors  and  smaller  effective  sensor  spacings  can  be  used.  For  the 
hexagonal  search  path  shown  in  figure  4-1,  and  a  pulse  repetition  interval  of  2 
seconds,  a  minimum  of  20  experiment  vectors  with  an  effective  sensor  spacing  of  35 
pulse  repetition  intervals  are  required  to  obtain  a  decent  estimate  of  the  acoustic 
beacon's  position  for  a  stationary  beacon.  For  the  moving  beacon,  assuming  the  same 
search  path,  a  minimum  of  30  experiment  vectors  with  an  effective  sensor  spacing  of 
45  pulse  repetition  intervals  are  required. 

In  chapter  V  design  specifications  for  a  receiver  to  implement  the  algorithms 
given  in  chapters  II  and  III  were  developed.  The  synchronous  time  of  receipt  was 
measured  by  determining  the  time  of  arrival  of  the  acoustic  beacon's  envelope.  To 
determine  the  arrival  time  of  the  acoustic  beacon's  envelop,  the  beacon's  carrier 
frequency  was  first  removed  using  a  precision  rectifier  with  a  low  pass  filter  to  form 
an  envelope  detector.  The  output  of  the  envelope  detector  was  then  logarithmically 
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compressed  to  increase  the  dynamic  resolution  of  the  receiver.  Next,  the  output  of  the 
logarithmic  compressor  was  digitally  sampled  using  a  68HC11  microcontroller. 
Following  A/D  conversion,  the  sampled  envelope  was  passed  through  a  digital 
matched  filtered.  For  a  rectangular  windowing  function,  this  produces  a  unique 
maximum  output  which  was  used  to  determine  the  time  of  arrival.  Following  the 
design  specifications,  a  receiver  was  built  from  commonly  available  components. 
Experiments  conducted  on  receiver  showed  that  the  test  receiver  met  the  design 
specifications  of  section  5.2. 
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Appendix  1 

This  appendix  contains  the  scK’natic  diagrams  for  the  receiver  designed  in 
chapter  V. 
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Appendix  2 


This  appendix  contains  the  source  code  used  by  the  68HC11.  The  code  is 
based  on  a  full  function  SAIL  driver  written  by  Dr.  Albert  Bradley  and  operates  under 
serial  communication  interrupt  control.  The  sampling  rate  of  die  A/D  converter  is  set 
by  using  a  Timer  Output  Compare  function.  After  the  microcontroller  finishes  an 
initialization  period,  it  sits  in  a  wait  state  until  a  serial  communications  interrupt  or  a 
timer  output  compare  interrupt  occurs.  Once  the  interrupt  is  received,  the 
microcontroller  executes  the  requested  task,  and  then  returns  to  die  wait  state. 


#PTR  Driver 

THE  MINIMUM  POWER  DRAIN  IS- 

2.5  MA  IF  IN  WAIT  LOOP,  4.9152  MHZ 
6-7  MA  IF  WORKING,  NO  LOADS 


Mon,  Sep  17,  1990,  19:21  MINOR  CLEANUPS 
IT  CONTAINS- 

-?M  AND  !M  ARE  OPTIONAL  DEPENDING  ON  THE  'BIG'  FLAG 
-FULL  BAUD  SWITCH  CAPABILITY 
-FULL  USE  OF  EVEN  PARITY 
-FULL  TTY  HANDLES 


PROC  "68HCI 1" 

;  THIS  IS  THE  CONTROL  FOR  THE  CONDITIONAL  ASSEMBLY  OF  THE  !M  AND  7M 
SECTIONS 

;  =1  WILL  INCLUDE  THEM 

;  =0  WILL  EXCLUDE  THEM  (SAVES  $118  BYTES  OF  CODE) 

LOAD:  EQU  1 

VIEW:  EQU  1 


DEFAULT  PARAMETERS 


DBAUD: 

EQU 

$30 

SAMPLE: 

EQU 

S07D1 

RADBUFF: 

EQU 

$3000 

ADBFULL: 

EQU 

$300B 

MAXBUF1: 

EQU 

$3100 

MAXBUF2: 

EQU 

$3200 

START  UP  AT  9600  BAUD  WITH  8.0  MHZ  XTAL 
l.OmSEC  SAMPLING  RATE  (ADJUSTED  FOR  ERRORS) 
LOCATION  OF  RUNNING  A/D  BUFFER 
,A/D  BUFFER  FULL  AT  1 1  VALUES  (0-10) 

LOCATION  OF  BUFFER  1 
LOCATION  OF  BUFFER  2 
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ATTNINC: 

ATTNDEC: 

MAX1FL: 

MAX2FL: 


EQU  $E8 
EQU  $40 
EQU  S310F 
EQU  S320F 


INCREASE  ATTN  AT  4.75  VOLTS 
INCREASE  THE  PREAMP  GAIN  AT  THIS  LEVEL 
CHECK  VALUE  TO  INITIALIZE  MAX  BUFFER 
CHECK  VALUE  TO  INITIALIZE  MAX  BUFFER 


;  ATTENUATOR  LEVELS 


DB00 

DB03 

DB09 

DB12 

DB18 

DB24 

DB30 


EQU 

EQU 

EQU 

EQU 

EQU 

EQU 

EQU 


$01 

$09 

$11 

$19 

$21 

$81 

$B9 


0  DB  ATTEN 
3  DB  ATTEN 
9  DB  ATTEN 
12  DB  ATTEN 
18  DB  ATTEN 
24  DB  ATTEN 
30  DB  ATTEN 


DMAXNUM: 

DPERIOD: 


EQU 

EQU 


$02 

$07D0 


DEFAULT  NUMBER  OF  MAX  POINTS  TAKEN 
DEFAULT  TO  2  SECOND  PERIOD 


DWIND:  EQU 

> 

$0014 

DEFAULT  INDEX  WINDOW 

> 

RP: 

EQU 

$0000 

REGISTER  PAGE  ON  BASE  PAGE 

PORTA 

EQU 

RP+S00 

|OC  1  0C2.0C3.0C4!0C5.IC  1  IC2.IC3| 

PORTC 

EQU 

RP+$03 

PORTB 

EQU 

RP+$04 

DDRC: 

EQU 

RP+$07 

PORTD:  EQU 

RP+$08 

|X.X.SS.SCK!MOSI.MISO.TXD.RXD| 

DDRD: 

EQU 

RP+$09 

PORTE 

EQU 

RP+$0A 

|V7.V6.V5.V4!X.X.X.BRK| 

BAT.BAUD. 

CFORC 

EQU 

RP+$0B 

TIMER  COMPARE  FORCE  REGISTER 

OC1M: 

EQU 

RP+$0C 

OUT  COMP  1  MASK  REG 

OC1D: 

EQU 

RP+$0D 

OUT  COMP  1  DATA  REG 

TCNT: 

EQU 

RP+$0E 

TIMER  REGISTER  (HIGH  BYTE) 

DTIC1: 

EQU 

RP+$10 

TIMER  INPUT  CAPTURE  1  (HI  BYTE) 

DTIC2: 

EQU 

RP+$12 

TIMER  INPUT  CAPTURE  2  (HI  BYTE) 

DTIC3: 

EQU 

RP+$14 

TIMER  INPUT  CAPTURE  3  (HI  BYTE) 

DTOC1 

EQU 

RP+$16 

TIMER  OUTPUT  COMPARE  1  (HI  BYTE) 

DTOC2 

EQU 

RP+$18 

TIMER  OUTPUT  COMPARE  2  (HI  BYTE) 

DTOC3 

EQU 

RP+$1A 

TIMER  OUTPUT  COMPARE  3  (HI  BYTE) 

DTOC4 

EQU 

RP+$1C 

TIMER  OUTPUT  COMPARE  4  (HI  BYTE) 

DTOC5 

EQU 

RP+$1E 

TIMER  OUTPUT  COMPARE  5  (HI  BYTE) 

TCTL1: 

EQU 

RP+$20 

TIMER  CONTROL  REG  1 

TCTL2: 

EQU 

RP+$21 

TIMER  CONTROL  REG  2 

TMSK1 

EQU 

RP+$22 

TIMER  INTERRUPT  MASK  REG  1 

TFLG1: 

EQU 

RP+$23 

TIMER  INTERRUPT  FLAG  REG  1 

TMSK2:  EQU 

RP+$24 

TIMER  INTERRUPT  MASK  REG  2 

TFLG2: 

EQU 

RP+$25 

TIMER  INTERRUPT  FLAG  REG  2 

PACTL:  EQU 

RP+$26 

PULSE  ACCUMULATOR  CONTROL  REG 

PACNT:  EQU 

RP+$27 

PULSE  ACCUMULATOR  COUNT  REG 

SPCR: 

EQU 

RP+$28 

SPI  CONTROL  REGISTER 

SPSR: 

EQU 

RP+$29 

SPI  STATUS  REGISTER 
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SPDR: 

EQU 

RP+S2A 

BAUD: 

EQU 

RP+S2B 

SCCR1: 

EQU 

RP+S2C 

SCCR2: 

EQU 

RP+S2D 

SCSR: 

EQU 

RP+S2E 

SCDR: 

EQU 

RP+S2F 

ADCTL: 

EQU 

RP+S30 

ADR1: 

EQU 

RP+S31 

ADR2: 

EQU 

RP+S32 

ADR3: 

EQU 

RP+S33 

ADR4: 

EQU 

RP+S34 

OPTION: 

EQU 

RP+S39 

HPRIO: 

EQU 

RP+J3C 

INIT: 

> 

EQU 

RP+S3D 

SAIL  inteface  RAM  workspace 


RJUMP: 

EQU 

$40 

RVECT: 

EQU 

$41 

* 

$42 

XJUMP: 

EQU 

$43 

XVECT: 

EQU 

$44 

* 

$45 

JUMP2: 

EQU 

$46 

VECT2: 

EQU 

$47 

* 

$48 

SCRTCH1: 

EQU 

$49 

SCRTCH2: 

EQU 

$4A 

SCRTCH3: 

EQU 

$4B 

SCRTCH4: 

EQU 

$4C 

SCRTCH5: 

EQU 

$4D 

XTTY: 

EQU 

$4E 

> 

• 

$4F 

> 

;  PTR  Data  inteface  RAM  workspace 

PERINDX: 

EQU 

$50 

9 

$51 

PERIOD: 

EQU 

$52 

» 

$53 

MAXBUFF: 

EQU 

$54 

* 

$55 

MAXFULL: 

EQU 

$56 

* 

$57 

ADBFPTR: 

EQU 

$58 

9 

$59 

TXBUFF: 

EQU 

$5A 

* 

$5B 

TXBFULL: 

EQU 

$5C 

;SPI  DATA  REGISTER 


;[RAM3.2.1.0!REG3.2.1.0] 


JUMP  INST  GOES  HERE.. 
HI 
LO 

XMIT  JUMP  INST 
HI 
LO 

2ND  JUMP  INST 
HI 
LO 

SCRATCH  LOC  1 
SCRATCH  LOC  2 
SCRATCH  LOC  3 
SCRATCH  LOC  4 
SCRATCH  LOC  5 

;TTY  POINTER  HI 
LOW 


PERIOD  TIMER  INDEX  HI 
LOW 

LENGTH  OF  PERIOD  HI 
LOW 

MAXIMUMS  BUFFER  LOCATION  HI 
LOW 

MAX  BUFFER  FULL  LOCATION  HI 
LOW 

RUNNING  A/D  BUFFER  LOCATION  HI 
LOW 

MAXIMUMS  BUFFER  TO  TX  HI 
LOW 

TX  BUFFER  FULL  LOCATION  HI 
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* 

S5D 

LOW 

TX1FLG: 

EQU 

S5E 

FIRST  MAXIMUMS  SENT  FLAG 

TX2FLG: 

EQU 

S5F 

SECOND  MAXIMUMS  SENT  FLAG 

MAXFLG: 

EQU 

$60 

WHICH  MAXIMUM  BUFFER  TO  SAVE  FLAG 

AGCFLG: 

EQU 

$61 

MANUAL  GAIN  CONTROL  FLAG 

BIG: 

EQU 

$62 

LARGEST  A/D  VALUE  PER  PERIOD  LOCATION 

MAXNUM: 

EQU 

$63 

NUMBER  OF  MAXIMUMS  LOCATION 

TXMHI: 

EQU 

$64 

TRANSMIT  OUT  BUFFERS 

TXMLO: 

EQU 

$65 

TXIHI: 

EQU 

$66 

TXILO: 

EQU 

$67 

TXINT: 

EQU 

$68 

INTERM  STORAGE  FOR  TX  POINTER 

TEMPIND: 

EQU 

$70 

INTERM  STORAGE  FOR  MAXIMUM  INDEX 

TEMPMAX: 

EQU 

$72 

INTERM  STORAGE  FOR  MAXIMUM 

WINDOW: 

EQU 

$74 

MAXIMUM  CHECK  WINDOW  SIZE 

WINCHK: 

EQU 

$76 

USED  FOR  TESTING  IF  WITHIN  WINDOW 

INDXCHK: 

» 

EQU 

$78 

ORG 

SE800 

.ASSUME  27C64  EPROM 

;  SAIL  Address  stored  here.. 

ADDR: 

FCB 

*#PTR" 

SAIL  ADDRESS 

* 

FCB 

$00 

.TERMINATOR 

START: 

SEI 

CLR 

$103D 

MOVE  REGISTERS  TO  BASE  PAGE  (00->  INIT) 

LDS 

#$00FF 

SET  STACK  POINTER 

LDAA 

#DBAUD 

SET  DEFAULT  BAUD 

STAA 

BAUD 

CLR 

SCCR1 

,8  DATA  BITS,  WAKE  ON  IDLE7 

LDAA 

#S2C 

.ONLY  REC  INTERRUPTS  YET 

STAA 

SCCR2 

,  PTR  TIMER  INTERUPT  INITIALIZATION 

LDAA 

#$40 

.TOGGLE  OC2  ON  EACH  COMPARE 

STAA 

TCTLl 

CLR 

TMSK2 

.SET  PRESCALE  TO  /I 

LDAA 

#$90 

.TURN  ON  THE  A/D  CONVERTER 

STAA 

OPTION 

LDAA 

#$20 

.USE  PEO  FOR  A/D  INPUT,  SINGLE  CHANNEL, 

STAA 

ADCTL 

.CONTINUOUS  SAMPLING 

LDAA 

#$88 

.SET  PORT  A  PINS  7  AS  OUTPUT 

STAA 

PACTL 

CLR 

MAXFLG 

.INITIALIZE  TO  FIRST  MAXIMUMS  BUFFER 

CLR 

TXIFLG 

.INITIALIZE  TO  NOT  TXT) 

CLR 

TX2FLG 

.INITIALIZE  TO  NOT  TXD 

CLR 

AGCFLG 

.INITIALIZE  TO  AGC  ON 

CLR 

BIG 

.INITIALIZE  THE  LARGEST  VALUE  TO  ZERO. 

CLR 

TXMHI 

.CLEAR  THE  OUTGOING  BUFFERS 
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CLR 

TXMLO 

CLR 

TXIHI 

CLR 

TXILO 

LDAA 

#DB00 

;SET  0  DB  OF  ATTENUATION 

STAA 

PORTA 

LDD 

#RADBUFF 

;SET  A/D  DATA  BUFFER  LOCATION  IN  BASE  PAGE 

STD 

ADBFPTR 

LDX 

#MAXBUF1 

;SET  FIRST  MAX  BUFFER  LOCATION  IN  BASE  PAGE 

STX 

MAXBUFF 

STX 

TXBUFF 

LDAB 

#DMAXNUM 

ADDB 

#DMAXNUM 

STAB 

ABX 

MAXNUM 

;SET  THE  NUM  MAX  CHECK  VALUE 

STX 

MAXFULL 

;SET  BUFFER  FULL  TO  2xDMAXNUM 

STX 

TXBFULL 

LDD 

#DPERIOD 

;SET  THE  PERIOD  SIZE 

STD 

PERIOD 

LDX 

#$0000 

STX 

PERINDX 

•.INITIALIZE  PERIOD  TIMER  TO  ZERO 

LDAA 

#$00 

LDX 

ADBFPTR 

CLRAD: 

STAA 

INX 

S00.X 

.CLEAR  THE  RUNNING  A/D  BUFFER 

CPX 

#ADBFULL 

BLO 

CLRAD 

LDX 

#MAXBUF1 

;CLEAR  THE  FIRST  MAXIMUM  BUFFER 

CLMX1: 

STAA 

INX 

$oo,x 

CPX 

#MAX1FL 

BLS 

CLMX1 

LDX 

#MAXBUF2 

;CLEAR  THE  SECOND  MAXIMUM  BUFFER 

CLMX2: 

STAA 

INX 

S00.X 

CPX 

#MAX2FL 

BLS 

CLMX2 

LDD 

#DWIND 

;SET  DEFAULT  INDEX  WINDOW 

STD 

WINDOW 

CLR 

SCRTCH1 

;USE  AS  SAIL  MODE  FLAG  &  ADDR  POINTER 

LDAA 

#$7E 

;MUST  WRITE  JMP  INSTS. 

STAA 

RJUMP 

.INTO  SAIL  WORK  AREA 

STAA 

XJUMP 

STAA 

JUMP2 

LDD 

#SETUNAD 

.SET  VECTORS  TO  INITIAL  VALUES 

STD 

RVECT 

STD 

XVECT 

CLI 

;AND  FINALLY  ALLOW  INTERRUPTS 
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;  MAIN  PROGRAM  BODY 

LOOP:  WAI  ;WAIT  TILL  INTERRUPTED.. 

BRA  LOOP 


TIMER  INTERUPT  HANDLER 
Fri,  Jul  10,  1992,  13:02 
Wed,  Jul  22,  1992,  8:35 
Fri,  Apr  23,  1993,  9:12 
Thu,  May  20,  1993,  1:52  PM 


OC2:  LDD  DTOC2 

ADDD  #  SAMPLE 
STD  DTOC2 

LDAA  #$FF 
SUB  A  ADR1 
CMPA  BIG 
BLO  Til 
STAA  BIG 

Til:  LDX  ADBFPTR 

STAA  S00.X 
INX 

CPX  #ADBFULL 
BLO  TI2 
LDX  #RADBUFF 
TI2:  STX  ADBFPTR 

LDX  #RADBUFF 
LDY  #$0000 
SUMMING:  LDAB  $00,X 

ABY 
INX 

CPX  #ADBFULL 
BLO  SUMMING 

LDX  MAXBUFF 
LDD  PERINDX 
STD  TEMPIND 
CPD  WINDOW 

BHI  TI1_1_1 
CPY  S00JC 
BLO  Til  2 
STY  SOO^C 
LDD  TEMPIND 
STD  S10.X 
BRA  TIENDJ 


;GET  LAST  VALUE  IN  TOC2 
;AND  ADL  ONE  PERIOD  TO  IT 
•.STORE  BACK  IN  TOC2 

NORMALIZE  THE  A/D  VALUE 

;IS  A/D  VALUE  GREATER  THEN  BIG? 
;IF  IT  IS  STORE  IN  BIG  ELSE  MOVE  ON 


GET  THE  CURRENT  A/D  POSITION 
STORE  THE  VALUE 
UPDATE  THE  POINTER 

CHECK  IF  AT  LAST  A/D  STORAGE  LOCATION 
IF  NOT  INC  ADBPTR  AND  MOVE  ON 
IF  YES  REINITIALIZE  ADBPTR  AND  MOVE  ON 
SAVE  THE  A/D  STORAGE  POINTER 

GET  THE  A/D  BUFFER  LOCATION 
INITIALIZE  THE  SUMATION  VALUE 
GET  THE  A/D  VALUE  TO  ADD 
SUM=SUM+A/D 

CONTINUE  UNTIL  ALL  VALUES  IN  THE  A/D 
BUFFER  ARE  SUMMED 


;GET  THE  BUFFER  TO  WRITE  TO 
;SETUP  FOR  TESTING  MAX  VALUES 

;SEE  ^  THE  MAX  IS  CLOSE  TO  THE  START  OF 
THE  PERIOD 

;IF  NOT  MOVE  ON,  OTHERWISE 

.CHECK  FOR  A  NEW  MAXIMUM 

;IF  NOT  GOTO  CHECK  FOR  SECONDARY  MAX'S 

;IF  YES  JUST  REPLACE  CURRENT  MAX 
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TI1_1_1: 

ADDD 

WINDOW 

SEE  IF  THE  MAX  IS  CLOSE  TO  THE  END  OF  PERIOD 

CPD 

PERIOD 

BLO 

Til  1_2 

IF  NOT  MOVE  ON,  OTHERWISE 

CPY 

S00.X 

CHECK  FOR  A  NEW  MAXIMUM 

BLO 

TI1_2 

IF  NOT  GOTO  CHECK  FOR  SECONDARY  MAX'S 

STY 

S00.X 

IF  YES  JUST  REPLACE  CURRENT  MAX 

LDD 

TEMPIND 

STD 

$10,X 

BRA 

TIENDJ 

TI1_1_2: 

LDD 

PERINDX 

SUBD 

WINDOW 

STD 

WINCHK 

CPY 

S00.X 

CHECK  FOR  A  NEW  MAXIMUM 

BLO 

Til  2 

IF  NOT  CHECK  FOR  SECONDARY  MAX'S 

CPD 

sio7x 

CHECK  IF  WITHIN  WINDOW 

BHI 

TI1_1 

IF  NO  REPLACE  ALL  MAX’S 

STY 

S00.X 

IF  YES  JUST  REPLACE  CURRENT  MAX 

LDD 

TEMPIND 

STD 

S10.X 

TIENDJ: 

BRA 

TIEND 

TI1_1: 

LDD 

S00,X 

SHIFT  ALL  OLD  MAX'S  ONE  LOCATION  AND 

STY 

$00,X 

SAVE  THE  NEW  MAX  VALUE 

STD 

TEMPMAX 

LDY 

S10.X 

SHIFT  THE  INDICIES 

LDD 

TEMPIND 

STD 

S10.X 

STY 

TEMPIND 

LDY 

TEMPMAX 

INX 

INCREMENT  TO  THE  NEXT  MAX 

INX 

CPX 

MAXFULL 

SEE  IF  DONE 

BLO 

TI1_1 

BRA 

TIEND 

TI1_2: 

LDD 

S10.X 

CHECK  FOR  SECONDARY  MAX'S 

ADDD 

WINDOW 

SET  UP  INDEX  WINDOW 

STD 

INDXCHK 

INX 

;MOVE  TO  THE  NEXT  MAX 

INX 

CPX 

MAXFULL 

.SEE  IF  DONE 

BHS 

TIEND 

CPY 

S00.X 

.LOOK  FOR  NEW  SECONDARY 

BLO 

TI1_2 

LDD 

TEMPIND 

CPD 

INDXCHK 

IF  WITHIN  THE  WINDOW  OF  THE  LARGER  MAX 

BLO 

TIEND 

IGNORE  THE  VALUE 

LDD 

PERIOD 

SUBD 

PERINDX 
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CPD 

WINDOW 

BLO 

TIEND 

;IF  ON  THE  SCREEN  WRAP  IN  WINDOW  IGNORE 

* 

LDD 

PERINDX 

SUBD 

WINDOW 

CPD 

S10.X 

;IF  WITHIN  THE  WINDOW  OF  THE  SECONDARY 

BHI 

TI1_3 

STY 

$00,X 

;JUST  REPLACE  THE  ONE  VALUE 

LDD 

PERINDX 

STD 

S10.X 

BRA 

TIEND 

* 

TI13: 

LDD 

$00,X 

;ELSE  REPLACE  AND  SHIFT  OLD  VALUES  DOWN 

STY 

$00, X 

STD 

TEMPMAX 

LDY 

$10,X 

LDD 

TEMPIND 

STD 

$10,X 

STY 

TEMPIND 

LDY 

TEMPMAX 

INX 

INX 

CPX 

MAXFULL 

BLO 

TI1_3 

TIEND: 

LDX 

PERINDX 

;GET  THE  PERIOD  COUNTER  AND  INCREMENT 

INX 

CPX 

PERIOD 

;IS  THE  PERIOD  COMPLETED? 

BLO 

Till 

* 

INC 

MAXFLG 

BRCLR 

MAXFLG ,$0 1  ,TI7  ;ARE  WE  IN  MAXIMUMS  BUFFER  1  OR  27 

CLR 

TX1FLG 

.CLEAR  BUFFER  1  TXD  FLAG 

LDY 

#MAXBUF2 

BRA 

TI8 

TI7: 

CLR 

TX2FLG 

-.CLEAR  BUFFER  2  TXD  FLAG 

LDY 

#MAXBUF1 

TI8: 

STY 

MAXBUFF 

■.UPDATE  THE  BUFFER  TO  USE 

LDAB 

MAXNUM 

ABY 

STY 

MAXFULL 

; UPDATE  THE  FULL  BUFFER  VALUE 

* 

BRSET 

AGCFLG,$01,TI10  ;IF  MANUAL  GAIN  SET  DONT  CHECK  AGC 

LDAA 

BIG 

■JEST  IF  GAIN  NEEDS  TO  BE  DECREASED 

CMP  A 

#ATTNINC 

;IF  NOT  MOVE  ON 

BLO 

TI9 

JSR 

ATTN 

;GO  TO  ATTN  FOR  MORE  ATTENUATION 

BRA 

TI10 

TI9: 

CMPA 

#ATTNDEC 

JEST  IF  GAIN  NEEDS  TO  BE  INCREASED 

BHI 

TI10 

;IF  NOT  MOVE  ON 

JSR 

INC 

;GO  TO  INC  FOR  LESS  ATTENUATION 
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TI10: 

CLR 

BIG 

i 

LDX 

#$0000 

Till: 

STX 

PERINDX 

LDAA 

#$40 

STAA 

RTI 

TFLG1 

.RESET  BIG  FOR  NEXT  PERIOD 
•.CLEAR  THE  PERIOD  COUNTER 
;RESET  TIMER  FLAGS 


;  SCI  INTERRUPT  HANDLER  (SAIL  DRIVER) 

Sat.  May  12.  1990,  20:34  COMPACT  BY  20  BYTES  BY  USING  RSET: 

Sun,  May  13,  1990,  12:36  COMPACT  BY  USING  CONDITIONAL  ASSEMBLY 
Sun,  May  13,  1990,  12:37  AND  BY  USING  TTY  FOR  PROMPT 
;  Mon,  Sep  17,  1990,  19:20  ADD  IN4  TO  TTY 
SCI:  BRCLR  SCSR,$0E,CKCHAR  ;TEST  FOR  VALID  CHAR 


& 

LDAA 

SCSR  ;TEST  OR.NF.FE 

ANDA 

#$0E 

BEQ 

CKCHAR 

IF  GOOD,  GO  ON.. 

LDAA 

SCDR 

READ  BAD  CHAR  TO  CLEAR? 

ECHO: 

NOP 

RECEIVE  AN  ECHO  CHARACTER  (&  IGNORE!) 

SCIXIT: 

RTI 

&  EXIT 

» 

CKCHAR: 

BRSET  SCSR,$20,READD 

;& 

LDAA 

SCSR 

TEST  DA 

9 

ANDA 

#$20 

9 

BNE 

READD 

JMP 

CHECKX  ;IF  NOT,  XMIT 

READD: 

LDAA 

SCDR 

READ  DATA  TO  A.. 

TAB 

and  COPY  TO  b 

LDX 

#PARITY 

POINT  PARITY  TABLE 

ABX 

POINT  INTO  PARITY  TABLE 

LDAB 

0.X 

GET  PARITY  WORD 

BNE 

SCIXIT 

REJECT  IF  NOT  EVEN  PARITY 

ANDA 

#$7F 

ELSE  REMOVE  PARITY  FOR  SUBSEQUENT  TESTS 

TAB 

(ALSO  COPY  TO  B) 

CMPA 

#’#’ 

IS  IT 

BEQ 

GOTNUM 

JMP 

RJUMP  ;ELSE  GO  THRU  VECTOR 

ATXIT: 

JMP 

SCIXIT  ;NO  FURTHER  USE  FOR  THIS  CHAR,  EXIT 

;  SAIL  ADDRESS  RECOGNIZE  SECTION 

GOTNUM: 

LDAB 

#01 

GOT  #  CODE 

STAB 

SCRTCH1 

SET  SAIL  FLAG  TO  01 

BCLR 

SCCR2,$D2 

TURN  OFF  XMIT  INTERRUPTS 

;& 

LDAA 

SCCR2 

f 

ANDA 

#$2C 

TURN  OFF  XMIT  INTERRUPTS 

* 

STAA 

SCCR2 

LDD 

#READAD  ; POINT  READ  ADDRESS 
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RSET: 

STD 

RVECT 

;..MAY  ENTER  HERE  FROM  MANY  OTHER  PLACES 

JMP 

SCIXIT 

;AND  EXIT 

> 

READAD: 

LDAB 

SCRTCH1 

;GET  SMODE  COUNT 

CMPB 

BNE 

#$01 

TRYADD 

;IS  THIS  THE  FIRST  CHAR? 

CMPA 

W 

;IF  FIRST,  IS  IT  ’0“? 

* 

BEQ 

TSTBAUD 

;IF  SO,  MAY  BE  BAUD  SWITCH 
;CONTINUE  ON  BELOW... 

TRYADD: 

LDX 

ABX 

#ADDR 

-.ELSE  POINT  X  TO  ADDR 
;ADD  TO  X 

CMPA 

0.X 

;COMPARE  NEW  CHAR  TO  A 

BEQ 

NEXTAD 

;IF  MATCH,  LOOK  FOR  NEXT  IN  LIST 

SETUNAD: 

LDD 

#UNADDR 

;ELSE  SET  UNADDRESS  STATE 

STD 

RVECT 

UNADDR: 

CLR 

SCRTCH1 

.CLEAR  SAIL  MODE  TO  00 

BCLR 

SCCR2.SD2 

;TURN  OFF  XMIT  INTERRUPTS 

;& 

LDAA 

SCCR2 

* 

ANDA 

#$2C 

-.TURN  OFF  XMIT  INTERRUPTS 

> 

STAA 

SCCR2 

LDD 

#XPASS 

.SET  XMIT  VECTOR  TO  PASS 

XSET: 

STD 

XVECT 

JMP 

SCIXIT 

NEXTAD: 

INX 

.POINT  NEXT  ADD  CHAR 

INC 

SCRTCH1 

;(&  INC  COUNTER) 

TST 

o,x 

;TEST  IT, 

BEQ 

GOTADDR 

;  TERMINATOR? 

JMP 

SCIXIT 

;ELSE  SAME  VECTOR 

GOTADDR: 

LDD 

#CONCHAR 

;REC  CONTROL  CHAR  NEXT.. 

JMP 

RSET 

;  TEST  FOR  BAUD  CHANGE  COMMAND 

TSTBAUD: 

LDD 

#BAUD2 

JMP 

RSET 

BAUD2: 

CMPA 

BEQ 

#’ O' 

BAUD3 

;GOT  SECOND  0? 

JMP 

SETUNAD 

;  COME  HERE  IF  GOT 

#00  (BAUD  CHANGE) 

BAUD3: 

LDX 

#SCRTCH1 

;POINT  TO  5  CHAR  BUFFER 

STX 

LDD 

VECT2 

#BAUD4 

;SAVE  AT  VECT2 

JMP 

RSET 

BAUD4: 

LDX 

VECT2 

;GET  POINTER 

CMPA 

#” 

;IS  rr  SPACE? 
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BNE 

BAUD5 

LDAA 

W 

..CHANGE  SPACES  TO  0'S 

BAUD5: 

STAA 

0.X 

STORE  CHAR 

INX 

ADVANCE  POINTER 

CPX 

#SCRTCHl+5  .PAST  END  OF  5  CHAR  BUFFER? 

BEQ 

BAUD6 

STX 

VECT2  ;IF  NOT  DONE,  SAVE  POINTER 

JMP 

SCIXIT  ;AND  GET  MORE 

BAUD6: 

LDX 

SCRTCH1+3 

GET  LAST  TWO  CHARS 

CPX 

#$3030 

ARE  LAST  TWO  CHARS  BOTH  0? 

BNE 

WAITBRK 

IF  NOT  VALID,  SET  UP  TO  WAIT  FOR  BREAK 

|  IF  LAST  TWO  CHARS 

ARE  00,  CHECK  BUFFER  AGAINST  DATA  TABLES  FOR  A  MATCH 

LDD 

#BAUDTBL 

SET  UP  TABLE  POINTER 

STD 

VECT2  AND  STORE  IN  JUMP2  VECTOR 

;  TRY  EACH  TABLE  SEPARATELY,  00  AS  1ST  CHAR  SIGNALS  END  OF  TABLE 

BTRY: 

LDX 

VECT2 

GET  TABLE  POINTER 

LDAA 

o,x 

AND  TABLE  ELEMENT 

BEQ 

WAITBRK 

IF=00,  WAS  NO  MATCH,  WAIT  FOR  BREAK 

;  COMPARE  BUFFER  WITH  ONE  TABLE  ENTRY 

LDX 

#SCRTCH1 

INIT  BUFFER  POINTER  TO  TOP 

STX 

XVECT 

&  SAVE  IN  XMIT  JUMP  VECTOR 

;  COMPARE  EACH  CHARACTER 

COMPARE: 

LDX 

XVECT 

GET  BUFFER  POINTER 

LDAA 

0.X 

TO  GET  BUFFER  CHAR  TO  A 

INX 

INX  BUF  POINT  WHILE  WERE  HERE 

STX 

XVECT 

&  SAVE- 

LDX 

VECT2 

NOW  GET  TABLE  POINTER 

CMPA 

o,x 

&  USE  TO  COMPARE  CHARS 

BNE 

NOMATCH 

CMATCH: 

INX 

IF  MATCH,  MOVE  AHEAD  TABLE  POINTER 

LDAA 

0.X 

LOOK  AT  NEXT  TABLE  ELEMENT 

BEQ 

MATCH 

IF  IT'S  00,  FULL  MATCH! 

STX 

VECT2 

ELSE  SAVE  TABLE  POINTER 

BRA 

COMPARE 

AND  TRY  NEXT  CHAR 

NOMATCH: 

INX 

INC  TABLE  POINTER 

LDAA 

ox 

AND  LOOK  FOR  00 

BNE 

NOMATCH 

LOOP  TILL  ITS  FOUND 

INX 

INC  OVER  NULL 

INX 

&  BAUD  SET  BYTE 

STX 

VECT2 

AND  REPLACE  TO  HOLDING  LOCATION 

BRA 

BTRY 

GO  BACK  TO  CHECK  NEXT  TABLE 

WAITBRK: 

LDAA 

#$0C 

.TURN  OFF  SCI  INTERRUPTS 

STAA 

SCCR2 

(REQUIRES  TOF  INTERRUPT  TO  RESTART) 

JMP 

SETUNAD 

,AND  SET  VECTORS  FOR  NEW  ADDRESS.. 
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.•BAUD*  ALL  LINES  WITH  THIS  ITEM  ARE  MODIFIED  FOR  EACH  BAUD  GROUP 

;  MATCH  TABLE  FOR  BAUD  RATE  SWITCH 

BAUDTBL: 

FCB 

'096',$00,$30 

9600 

•BAUD* 

FCB 

'048',S00,$3 1 

4800  BAUD 

•BAUD* 

FCB 

,024',$00,$32 

2400 

♦BAUD* 

FCB 

'012',$00,$33 

1200 

•BAUD* 

FCB 

•006’,$00,$34 

600 

♦BAUD* 

FCB 

'003', $00  .S3  5 

300 

•BAUD* 

FCB 

$00 

DONE 

MATCH: 

INX 

PASS  00  TERMINATOR 

LDAA 

ox 

GET  BAUD  BYTE 

STAA 

BAUD 

AND  RE-WRITE 

JMP 

SETUNAD 

AND  PREPARE  FOR  NEW  ADDRESSING... 

?M  COMMAND  -  DATA  INPUT  SECTION 
if  VIEW 


QUERYM: 

LDD 

#SAVEADD 

;NOW  INPUT  ADDRESS 

JMP 

IN4 

> 

SAVE  ADD: 

LDD 

SCRTCH1 

.GET  ADDRESS, 

STD 

SCRTCH3 

;&  SAVE  IN  ADDRESS  POINTER 

LDD 

#STARTL 

JMP 

IN4 

.THEN  GET  LENGTH 

STARTL: 

LDD 

SCRTCH1 

;IF  LENGTH  NE  0000 

BNE 

STARTL2 

;  CARRY  ON.. 

JMP 

PROMPT 

;ELSE  QUIT 

STARTL2: 

LDD 

#ECHO 

.PREPARE  TO  IGNORE  ECHO  CHARS 

STD 

RVECT 

BSET 

SCCR2,$E0 

;START  XMIT  INTERRUPTS 

;& 

LDAA 

SCCR2 

ORAA 

#$E0 

;START  XMIT  INTERRUPTS 

STAA 

SCCR2 

JMP 

OUTLINE 

;&  SEND  A  LINE.. 

* 

;  .THE  ?M  DUMP  IS  STORED  IN  THE  XMIT  SERVICE  SECTION  BELOW 
else 
endif 


;  !M  SECTION 

IF 

LOAD 

CONDITIONAL  ASSEMBLY  OF  LOAD  M  SECTION 

BANGM: 

LDD 

#KEEPADD 

; INPUT  STARTING  ADDRESS 

JMP 

IN4 

KEEPADD: 

LDD 

#HIHEX 

.WAIT  FOR  HIGH  HEX  CHAR 
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JMP 

RSET 

HIHEX: 

JSR 

ASCHEX 

BCS 

TERMIN 

ASLA 

ASLA 

ASLA 

ASLA 

STAA 

SCRTCH5 

LDD 

#LOWHEX 

JMP 

RSET 

LOWHEX: 

JSR 

ASCHEX 

BCC 

STASH 

JMP 

PROMPT 

STASH: 

LDX 

SCRTCH1 

ORAA 

SCRTCH5 

STAA 

0.X 

INX 

STX 

SCRTCH1 

LDD 

#HIHEX 

JMP 

RSET 

TERMIN: 

ANDA 

#$7F 

CMPA 

#$0D 

BNE 

TERMIN2 

JMP 

PROMPT 

TERMIN2: 

CMPA 

BNE 

TERMIN3 

LDD 

#HIHEX 

JMP 

RSET 

TERMIN3: 

CMPA 

#V 

BNE 

TERMIN4 

LDD 

#BANGM 

BRA 

PASSLF 

TERMIN4: 

CMPA 

#7 

BNE 

TERMIN5 

LDD 

#SETHIHX 

PASSLF: 

STD 

VECT2 

LDD 

#PASSLF2 

JMP 

RSET 

PASSLF2:CMPA 

#S0A 

BNE 

PXIT 

JMP 

JUMP2 

PXIT: 

JMP 

SCIXIT 

SETHIHX: 

LDD 

#HIHEX 

•.ATTEMPT  CONVERT  TO  HEX 
.CHECK  TERMINATOR  IF  NOT.. 

;MOVE  OVER  NIBBLE 


;CONVERT  LOW 

.PROMPT  IF  BAD  SECOND  CHAR 
;GET  POINTER 
•.COMBINE  NIBBLES 
•.STORE  IT.. 

;INC  & 

RESTORE  POINTER 


.MASK  OFF  FLAG  BIT 

•.is  rr  cr? 


;IS  IT  SPACE? 


;OR  V  ? 


;OR  V  ? 


;GOT  LF  YET? 

;IF  *  ES.  EXIT  THRU  JMP2 
•.ELSE  WAIT  FOR  MORE  CHARS.. 

.IF  THEN  PREP  FOR  MORE  HEX 
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JMP 


RSET 


TERMIN5: 


JMP  PROMPT  ;TO  PROMPT  IF  NOT  VALID  CHAR 
endif 


IN4  HEX  DIGITS 

INPUTS  HEX  DIGITS  TILL  TERMINATED  BY  A  SPACE  OR 
BY  A  CR.  (OR  BY  UNADDRESS).  RESULT  LEFT  AT  SCRTCHU 
EXITS  THRU  JUMP2  WHEN  DONE  (TARGET  IN  D  ON  ENTRY) 


IN4: 

STD 

VECT2 

CLR 

SCRTCH1 

CLR 

SCRTCH2 

LDD 

#IN4HEX 

JMP 

RSET 

IN4HEX: 

JSR 

ASCHEX 

BCS 

CKEND 

PSHA 

LDAA 

SCRTCH1 

LDAB 

SCRTCH2 

ASLD 

ASLD 

ASLD 

ASLD 

STAA 

SCRTCH1 

STAB 

SCRTCH2 

PULA 

ORAA 

SCRTCH2 

STAA 

SCRTCH2 

JMP 

scixrr 

y 

CKEND: 

ANDA 

#$7F 

CMPA 

r  • 

BEQ 

INEXIT 

CMPA 

#S0D 

BEQ 

INEXIT 

JMP 

SCIXIT 

INEXIT: 

JMP 

JUMP2 

.STORE  EXIT  VECTOR 
.CLEAR  INPUT  BUFFER 

;POINT  CHAR  RECEIVER 


.CONVERT  TO  HEX 

;IF  NOT  HEX.  CHECK  FOR  END 

■.SAVE.. 

;HI  TO  A 

.SHIFT  OVER  FOUR 


.RETURN  HIGH 
.AND  B 

RETRIEVE  NEW  NIBBLE 
ADD  NEW  NIBBLE 
A  UPDATE 


;CLEAN  OFF  MS  FLAG  BIT 
;IS  IT  SPACE? 

;IS  IT  CR? 

;ELSE,  GET  ANOTHER  CHAR 

;IF  DONE.  CARRY  ON  THRU  VECTOR. 


INPUT  ONE  HEX  BYTE  AND  CONTINUE  THRU  JUMP2 


INBYTE:  ASLA 

;MOVE  OVER 

ASLA 

ASLA 

ASLA 

STAA 

SCRTCH5 

;SAVE 

LDD 

#INBYTE2 

•.POINT  TO  NEXT  SEGMENT 

JMP 

RSET 
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INBYTE2: 

J^R 

BCC 

ASCHEX 

SAVEDAT 

.CONVERT  LOW  NIBBLE 

JMP 

SETUNAD 

;UN ADDRESS  IF  ERROR 

SAVEDAT 

:ORAA 

SCRTCH5 

;COMBINE 

JMP 

JUMP2 

;AND  CARRY  ON  THRU  VECTOR2 

NOW  CHECK  THE  TRANSMIT  SITUATION 


CHECKX: 

BRCLR 

SCSR.S80  .XERROR 

;& 

LDAA 

SCSR 

.MAKE  SURE  XMIT  BIT  WAS  SET 

ANDA 

#$80 

BEQ 

XERROR 

JMP 

XJUMP 

;GO  THRU  XMIT  VECTOR 

;  THESE  SEGMENTS  ARE  ENTERED  THRU  XJUMP  AND  X VECTOR  . 

XERROR: 

NOP 

•.TRIG  LOC  FOR  DIAGNOSTICS 

;  XJUMP  TARGETS.. 

XPASS: 

BCLR 

SCCR2.SD0 

;& 

LDAA  SCCR2 

ANDA  #S2F 

* 

STAA  SCCR2 

JMP 

SCIXIT 

» 

if 

VIEW 

;a  conditional  segment 

;  OUTPUT  A 

LINE  OF  DATA  (FROM 

?M  DUMP) 

OUTLINE: 

LDD 

#OUTLF 

,&  SET  UP  TO  XMIT 

STD 

XVECT 

LDAA 

#$0D 

;SEND  CR 

JMP 

SETOUT 

OUTLF: 

LDD 

#OUTADDR 

STD 

XVECT 

LDAA 

#$0A 

;SEND  LF 

JMP 

SETOUT 

OUTADDR: 

LDD 

#LOWADDR 

;PREP  OUTBYTE  XIT 

STD 

VECT2 

LDAA 

SCRTCH3 

;GET  HIGH  ADDRESS 

JMP 

OUTBYTE 

LOWADDR: 

LDD 

#LOWADD2 

^XIT  FROM  2ND  OUTBYTE.. 

JMP 

XSET 

LOWADD2: 

LDD 

#ADDRSP 

STD 

VECT2 

LDAA 

SCRTCH4 

;NOW  LOW  ADDRESS 

JMP 

OUTBYTE 
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ADDRSP: 

LDD 

#SENDSP 

JMP 

XSET 

SENDSP: 

LDD 

#OUTDATA 

STD 

XVECT 

LDAA 

#$20 

JMP 

SETOUT 

OUTDATA: 

LDX 

SCRTCH3 

LDAA 

PSHA 

0.X 

LDD 

#DECLEN 

STD 

PULA 

VECT2 

JMP 

OUTBYTE 

DECLEN: 

LDD 

#DECLEN2 

JMP 

XSET 

DECLEN2: 

LDX 

DEX 

SCRTCH1 

STX 

SCRTCH1 

BNE 

SAYMORE 

JMP 

PROMPT 

SAYMORE: 

LDX 

INX 

SCRTCH3 

STX 

XGDX 

LSRD 

SCRTCH3 

BCS 

OUTDATA 

ANDB 

#$07 

BNE 

SENDSP 

> 

LDAA 

#';' 

JSR 

GENPAR 

STAA 

SCDR 

LDD 

#OUTLINE 

JMP 

endif 

XSET 

.EXIT  FROM  2ND  OUTBYTE... 


•.SEND  SPACE 


;GET  ADDR  POINTER 
;TO  GET  DATA  BYTE 
-.SAVE 

;PREP  xrr  VECTOR 
.RETRIEVE  DATA  BYTE 
;&  SEND  IT 

.EXIT  FROM  OUTBYTE2.. 


.GET  LENGTH 
.DECREMENT 
,&  RETURN 
MORE  DATA? 

.PROMPT  IF  DONE 

.GET  ADDR 
.INCREMENT 
.REPLACE 
.X  REG  TO  ACCD 
,LSB  TO  C 

.NEXT  BYTE  NOW  IF  ODD 
.CHECK  FOR  XXXO  (LINE  END) 

.IF  ONLY  EVEN.  SEND  SP 

;IF  NEW  LINE,  SEND  CONTINUATION 


;&  PREP  FOR  NEW  LINE.. 


;  OUTPUTS  A  BYTE  IN  A  AS  TWO 
OUTBYTE.  STAA  SCRTCH5 
LSRA 
LSRA 
LSRA 
LSRA 

JSR  HEXASC 
PSHA 

LDD  #OUTBYT2 


HEX  CHARS,  EXITS  VIA  VECT2.. 
;STASH  FOR  LATER 

;MOVE  OVER 


.CONVERT 
;AND  SAVE.. 
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> 

OUTBYT2: 

9 

STD 

PULA 

JMP 

LDAA 

ANDA 

JSR 

JMP 

XVECT 

.RECOVER  CHARACTER 

SETOUT 

SCRTCH5 

#$0F  .CLEAN  UP 

HEXASC 

OUT  JMP  .CONVERT,  SEND  &  JUMP  THRU  VECT2 

;  SEND  A  PROMPT  FROM  THE  MONITOR,  THEN  WAIT  FOR  CHARS 

PROMPT: 

LDX 

JMP 

#PLIST 

TTYO 

PLIST: 

FCB 

FDB 

S0D,$0A,':',SEE,$90,SCRTCH1  ,$AA 

PJUMP 

PJUMP: 

LDAA 

SCRTCH1 

JMP 

CONCHAR 

;  INITIATE  AN  OUTPUT  SEQUENCE 
SETOUT:  JSR  GENPAR 


STAA  SCDR  ;SEND  FIRST  CHAR 

BSET  SCCR2.SC0 

,&  LDAA  SCCR2 

ORAA  #SCO  ;TURN  ON  INTERRUPTS  IF  REQT) 

STAA  SCCR2 

LDD  #ECHO  ;&  PREPARE  TO  ECHO 

JMP  RSET 


;  SENDS  ETX  &  CARRIES  ON  THRU  VECT2 


XETX: 

LDAA 

#$03 

;SEND  ETX 

OUT  JMP: 

JSR 

GENPAR 

.MAY  ENTER  HERE. 

STAA 

SCDR 

;DRAGON  AGAIN? 

JMP 

JUMP2 

;NOW  THRU  JUMP2 

SUBROUTINES  USED  BY  PTR  DRIVER. 


ATTN: 

LDAA 

PORTA 

GET  THE  VALUE  IN  PORT  A 

CMPA 

#DB00 

IS  0  DB  SET? 

BNE 

ATTN1 

IF  NO  GO  ON 

LDAA 

#DB03 

IF  YES  SET  3  DB 

STAA 

PORTA 

BRA 

ATTNF  ;Exrr 

ATTN1: 

CMPA 

#DB03 

.IS  3  DB  SET? 

BNE 

ATTN2 

;IF  NO  GO  ON 

LDAA 

#DB09 

,IF  YES  SET  9  DB 

STAA 

PORTA 

BRA 

ATTNF 

.EXIT 

ATTN2: 

CMPA 

#DB12 

;IS  12  DB  SET? 

BNE 

ATTN  3 

;IF  NO  GO  ON 
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LDAA 

#DB18 

;IF  YES  SET  18  DB 

STAA 

PORTA 

BRA 

ATTNF 

.EXIT 

ATTN3: 

CMPA 

1 

00 

;IS  18  DB  SET? 

BNE 

ATTN4 

;IF  NO  GO  ON 

LDAA 

#DB24 

;IF  YES  SET  24  DB 

STAA 

PORTA 

BRA 

ATTNF 

•.EXIT 

ATTN4: 

CMPA 

#DB24 

;IS  24  DB  SET? 

BNE 

ATTN5 

;IF  NO  GO  ON 

LDAA 

#DB30 

;IF  YES  SET  30  DB 

STAA 

PORTA 

BRA 

ATTNF 

;EXIT 

ATTN5: 

CMPA 

#DB30 

;IS  30  DB  SET? 

BNE 

ATTN6 

;IF  NO  GO  ON 

BRA 

ATTNF 

;IF  YES  CANT  CHANGE  ANYMORE 

ATTN6: 

LDAA 

#DB00 

;IF  NON  OF  THE  ABOVE  ARE  SET,  SET 

STAA 

PORTA 

ATTNF 

RTS 

INC: 

LDAA 

PORTA 

;GET  THE  VALUE  IN  PORT  A 

CMPA 

#DB30 

;IS  30  DB  SET? 

BNE 

INC1 

;IF  NO  GO  ON 

LDAA 

#DB24 

;IF  YES  SET  24  DB 

STAA 

PORTA 

BRA 

INCF 

;EXIT 

INC1: 

CMPA 

#DB24 

;IS  24  DB  SET? 

BNE 

INC  2 

;IF  NO  GO  ON 

LDAA 

#DB18 

;IF  YES  SET  18  DB 

STAA 

PORTA 

BRA 

INCF 

.EXIT 

INC2: 

CMPA 

#DBI8 

;IS  18  DB  SET? 

BNE 

INC3 

;IF  NO  GO  ON 

LDAA 

#DB12 

;IF  YES  SET  12  DB 

STAA 

PORTA 

BRA 

INCF 

-.EXIT 

INC3: 

CMPA 

#DB12 

;IS  12  DB  SET? 

BNE 

INC4 

.IF  NO  GO  ON 

LDAA 

#DB09 

;IF  YES  SET  9  DB 

STAA 

PORTA 

BRA 

INCF 

INC4: 

CMPA 

#DB09 

;IS  9  DB  SET? 

BNE 

INC  5 

;IF  NO  GO  ON 

LDAA 

#DB03 

;IF  YES  SET  3  DB 

STAA 

PORTA 

BRA 

INCF 

INC5: 

LDAA 

#DB00 

.IF  NON  OF  THE  ABOVE  ARE  SET,  SET 

STAA 

PORTA 

INCF 

RTS 
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SUBROUTINES  USED  BY  SAIL  DRIVER. 


Converts  low  nibble  in  A  to  ASCII  char  in  A 


HEXASC: 

ANDA 

#$0F 

•.CLEAN  IT  UP 

ADDA 

#$  F6 

BCC 

HNUMBER 

ADDA 

#$07 

;CONVERT 

HNUMBER: 

ADDA 

RTS 

#$3A 

;  TO  ASCII 

Converts  ASCII  char  in  A  to  nibble  in  A  if  it  is  HEX  &  clears  C 
Otherwise,  returns  origional  char  with  C  bit  set. 


ASCHEX: 

PSHA 

SUBA 

#$30 

;SAVE  CHAR 

BCS 

NOTHEX 

SUBA 

#$0A 

BGE 

TSTALPH 

ADDA 

#$0A 

;REPAIR  NUMB 

BRA 

AXIT 

TSTALPH: 

SUBA 

#$07 

;41->00  7 

BLT 

NOTHEX 

SUBA 

#$06 

BGE 

NOTHEX 

ADDA 

#$10 

;REPAIR  ALPH 

AXIT: 

INS 

;POP  OFF  SAVED  CHAR 

CLC 

.AND  CLEAR  CARRY  BIT 

RTS 

NOTHEX: 

PULA 

;GET  CHAR 

SEC 

.SET  CARRY 

RTS 


;  GENERATE  PARITY-  Char  is  passed  in  and  out  thru  A 

GENPAR:  PSHB 

;SAVE  SOME  STUFF.. 

PSHX 

TAB 

.COPY  CHAR  TO  B 

;  LDX  #PARITY 

-.POINT  TO  PARITY  TABLE  TOP 

;  ABX 

ADD  OFFSET  TO  POINT  X  TO  CHAR 

;  ORAA  0.X 

ADD  PARITY  BIT 

PULX 

...RESTORE 

PULB 

RTS 

9 

;  PARITY  TABLE 

PARITY:  FCB  S00,$80,S80,S00,S80,S00,S00,S80  A 

FCB  $80,S00,$00,$80,$00,$80,$80,$00  ;B 

FCB  S80,S00,S00,S80,S00, $80,580400  3 

FCB  $00,$80,$80,$00,$80,$00, $00480  A 

,  XX20 

FCB  $80,$00,$00,$80400,$80,$80,$00  ;B 
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;  XX40 


FCB  $00,S80,$80,$00,$80,$00,$00,$80  ;A 

FCB  $00,$80,S80,$00,$80,$00,$00,$80  ;A 

FCB  $80,$00,$00,$80,$00,$80,$80,$00  ;B 

FCB  $80,$00,$00,$80,$00,$80,$80,$00  ;B 

FCB  SOO,S80,S80,$00,S80,SOO,$00,S80  ;A 

FCB  $00,$80,$80,S00,$80,$00,S00,$80  ;A 

FCB  $80,S00,$00,S80,S00,$80,S80,S00  3 

;  XX60 

FCB  $00,S80,$80,$00,S80,S00,S00,S80  .a 

FCB  $80,S00,$00,S80,S00,S80,S80,S00  ;B 

FCB  $80,S00,$00,$80,$00,S80,$80,$00  ;B 

FCB  $00,$80,$80,$00,S80,$00,$00,S80  ;A 

;  XX.  O 

FCB  $80,$00,$00>$80,$00,S80)$80,SOO  ;B 

FCB  $00,$80,$80,s00,$80,$00,$00,$80  ;A 

FCB  $OO,S8O,S8O,SOO,S80,S0O,$O0,S80  ;A 

FCB  $80,$00,$00,$80>SOO,$80,S80,SOO  3 

;  XXAO 

FCB  S00,$80,S80,S00, $80, $00, $00,480  ;A 

FCB  $80,$00,$00,$80, $00,480, $80,400  3 

FCB  $80,$00,$00,$80,$00, $80,480,400  3 

FCB  $00,$80,S80,$00,S80,SOO,SOO,S80  ;A 

;  XXCO 

FCB  S00,S80,S80,S00,$80,$(K>,$00,$80  ;A 

FCB  $80 ,400,400 ,$80 ,400,480 ,480,400  3 

FCB  480,400,400,480,400,480,480,400  3 

FCB  400,480,480,400,480,400,400,480  ;A 

;  XXEO 

FCB  $80,400,400,480,400,480,480,400  ;A 

FCB  400,480,480,400,480,400,400,480  3 

FCB  $00,480,480,400,480 ,400 ,400 ,480  3 

FCB  480,400,400,480,400,480,480,400  ;A 


;  CHARACTER  LOOKUP  TABLE 

CHARTBL:  FCB  441,442,443,444,445,446,447,400 

00-07 

FCB  400,400,400,400,400,400,400,400 

08-0F 

FCB  $49,$4A,$4B,$4C,$4D,S4E,$50,$00 

10-17 

FCB  $00,$00,$00,$00,$00,$00,s00,$00 

18-1F 

FCB  $5 1  ,$52,$53,$54,$55,$56,$57,$0O 

20-27 

FCB  $00,$00,$00,$00,$00,$00,s00,s00 

28-2F 

FCB  459,45A,45B,45C,45D,45E,45F,475 

30-37 

FCB  $00,$00,s00,$00,$00,$00,$00,$00 

38-3F 

FCB  461,462,463,464,465,466,468,474 

40-47 

FCB  $00,$00,$00,$00,$00,$00,$00,$00 

48-4F 

FCB  $69,$6A,$6B,$6C,S6D,$6E,$70,S74 

50-57 

FCB  400,400,400,400,400,400,400,400 

58-5F 

FCB  $7 1  ,$72,$73,$74,$75,$76,$77,$72 

60-67 

FCB  $00,$00,$00.$00,$00,$00,$00,$00 

68-6F 
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;  HELP  FILE  DUMP 
SAYHELP:  LDX  #HELPFIL 

BRA  TTYO 


A  TTY  ROUTINE  FOR  SAIL68  **DO  NOT  DELETE!  USED  BY  PROMPT  ETC!** 

-USES  $FD  BYTES 

-TO  ENTER  FOR  XMIT,  LDX  Stable  AND  THEN  JMP  TTYO 
-TO  ENTER  IN  REC  MODE  LDX  Stable  AND  JMP  TTYRO 
-MUST  USE  EE  TO  SWITCH  FROM  SENDING  TO  REC  CHARS 
-CAN  GO  BACK  TO  SENDING  W/O  PROBLEM 
-ARG  TABLE  CODES.. 

ASCII  -TYPE  IT  AND  GO  ON  WITH  XMIT  INTERRUPTS  ON 
00  -BACK  TO  THE  PROMPT 

AA  aaaa  -JMP  TO  aaaa  WITH  XMIT  INTERRUPTS  STILL  ON  (USE  FDB!) 

80  aa  -SEND  CHAR  AT  LOC  aa 

81  aa  -SEND  HEX  PAIR  AT  LOC  aa 

EE  -SEND  ETX  &  WAIT  FOR  A  CHAR  (MUST  BE  FOLLOWED  BY  9X) 

90  aa  -REC  A  CHAR  AND  SAVE  IT  AT  aa 

91  aa  -REC  A  HEX  PAIR  AND  SAVE  IT  AT  aa  (ABORT  TO  PROMPT  ->HEX) 
94  aa  -CLEAR  SCRTCH 1 ,2  &  WAIT  FOR  A  HEX  STRING,  PUT  AT  aa,aa+l 

(ENTRY  TERMINATED  BY  SP  OR  CR) 


TTY: 

LDX 

XTTY 

.LOAD  X  FROM  STORAGE  LOCATION 

TTYO: 

LDD 

#TTY 

;SET  REENTER  VECTOR 

STD 

XVECT 

LDAA 

00.X 

;GET  ARGUMENT 

BNE 

TRYAA 

JMP 

PROMPT 

;!F  =00,  GO  DIRECTLY  TO  PROMPT. 

TRYAA: 

CMPA 

#$AA 

BNE 

TRYASC 

INX 

LDX 

ox 

•.VECTOR  TO  X 

JMP 

OX 

;AND  JUMP  TO  M(X) 

TRYASC: 

TSTA 

BMI 

TRY80 

;IF  MSB  IS  1,  NOT  ASCII.. 

JSR 

LBISX 

•ELSE  GET  THE  ASCII  IMM  CHAR 

TBA 

JMP 

SETOUT 

;GO  SEND  IT  NOW 

9 

TRY80: 

CMPA 

mo 

;REQ  IND  CHAR? 

BNE 

TRY81 

INX 

JSR 

LBISX 

;GET  THE  ADDRESS  (ASSUME  BASE  PAGE) 

JSR 

CRADDR 

•.CREATE  ADDRESS 

LDAA 

ox 

;GET  THE  IND  DATA 

JMP 

SETOUT 

TRY81: 

CMPA 

#$81 

;REQ  IND  HEX  PAIR? 

BNE 

TRYEE 
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INX 

JSR 

LBISX 

.GET  THE  ADDRESS  (ASSUME  BASE  PAGE) 

JSR 

CRADDR 

.CREATE  ADDRESS 

LDD 

#TTY2 

THEN  SET  UP  VECT2  EXIT  PATH 

STD 

VECT2 

LDAA 

o,x 

GET  THE  IND  DATA  NOW 

JMP 

OUTBYTE 

TTY2: 

LDD 

#TTY  .EXIT  PATH  FOR  VEC  C2  STUFF. 

JMP 

XSET  ;(ALLOWS  OUTBYTE  TO  RETURN  TO  TTY) 

TRYEE: 

CMPA 

#$EE  ;SEND  ETX  &  GO  TO  RECEIV  E  MODE? 

BEQ 

GOTEE 

TRERR: 

JMP 

PROMPT  ;IF  NOT  VALID  OUT  GROUP  CONTROL  CHAR,  JUST 

PROMPT 

GOTEE: 

INX 

SWITCH  TO  INPUT  MODE 

STX 

XTTY 

SAVE  THE  CONTROL  TABLE  POINTER 

LDAA 

#$03 

SEND  ETX 

JSR 

GENPAR 

STAA 

SCDR 

BCLR 

SCCR2.SC0  ;STOP  FURTHER  XMIT  INTERRUPTS 

LDD 

#TTY3 

AND  PREPARE  TO  RECEIVE  THE  ETX  ECHO 

JMP 

RSET 

TTY3: 

CMPA 

#$03  ;GOT  ETX  YET? 

BEQ 

TTY4  ;  KEEP  WAITING  TILL  IT  ECHOS 

JMP 

SCIXIT 

TTY4: 

LDD 

#TTYR 

WHEN  GOT  ETX,  PREP  TO  REC  DATA  CHARS 

JMP 

RSET 

SET  RVECT  TO  TTYR  AND  EXIT 

» 

;  TTY  RECEIVE  SECTION,  ENTER  HERE  FROM  COMMAND  CHAIN  W/O  NEW  CHAR 
TTYRO:  STX  XTTY  ;JUST  SAVE  TABLE  POINTER 

BRA  TTY4  ;  AND  GO  GET  A  NEW  CHAR 


;  ENTER  HERE  FROM  RVECT  WITH  DATA  CHAR  IN  A 


TTYR: 

LDX 

XTTY 

WHILE  WE  FIGURE  OUT  WHAT  TO  DO  WITH  IT 

JSR 

LBISX 

GET  THE  CONTROL  CHAR- 

TRY90: 

CMPB 

#$90 

SAVE  WHOLE  CHAR 

BNE 

TRY91 

SAVCHR: 

JSR 

LBISX 

IF  90,  SAVE  WHOLE  CHAR  AT  IMM  ADDRESS 

JSR 

CRADDR 

CREATE  ADDRESS 

STAA 

0.X 

SAVE  THE  DATA  BYTE  IN  M(X) 

BRA 

CKNEXT 

CHECK  NEXT  CONTROL  BYTE  FOR  TYPE  (READ  OR 

WRITE) 

TRY91: 

CMPB 

#$9l  ;ENTER  A  HEX  PAIR? 

BNE 

TRY94 

JSR 

ASCHEX 

BCS 

TRERR  ;ABORT  IF  NOT  HEX  CHAR 

180 


ASLA 

ASIA 

ASLA 

ASLA 

.MOVE  OVER 

STAA 

SCRTCH1 

;SAVE  TILL  NEXT  PASS 

LDD 

#TTYHEX 

.PREP  FOR  2ND  HEX  CHAR 

JMP 

RSET 

* 

TTYHEX: 

JSR 

ASCHEX 

;(  SECOND  HALF  OF  TRY91  ) 

BCS 

TRERR 

;ABORT  IF  NOT  A  VALID  HEX  CHAR 

ORAA 

SCRTCH1 

.COMBINE  HIGH  AND  LOW  CHARS 

LDX 

XTTY 

JSR 

LBISX 

;GET  SINK  ADDRESS 

JSR 

CRADDR 

•.CREATE  ADDRESS 

STAA 

0.X 

LDD 

#TTYR 

•.REPAIR  THE  VECTOR 

STD 

RVECT 

;  AND  ON  TO  CHECK  NEXT  COMMAND 

BRA 

CKNEXT 

> 

TRY94: 

CMPB 

#$94 

;IS  rr  IN4? 

BNE 

TRERR 

-.QUIT  IF  NOT  A  VALID  CODE 

GOT94: 

CLR 

SCRTCH1 

;GOT  FIRST  DIGIT  IN  A.  CLEAR  INPUT  BUFFER 

CLR 

PSHA 

SCRTCH2 

•.SAVE  THE  ARGUMENT 

LDD 

#SAVE4 

VECT2 

PREPARE  EXIT  VECTOR 

LDD 

#IN4HEX 

STD 

RVECT 

;CHANGE  RVECT 

PULA 

JMP 

IN4HEX 

;AND  PROCESS  THE  FIRST  DIGIT 

SAVE4: 

LDD 

#TTYR 

STD 

RVECT 

;REPAIR  THE  VECTOR 

LDX 

XTTY 

;GET  THE  TABLE  POINTER 

JSR 

LBISX 

;AND  GET  THE  SINK  ADDRESS 

JSR 

CRADDR 

.CREATE  ADDRESS 

LDD 

SCRTCH1 

;AND  STORE  THE  DOUBLE  BYTE 

STD 

0.X 

BRA 

CKNEXT 

.CHECK  NEXT  CONTROL  CHAR 

* 

CKNEXT: 

LDX 

XTTY 

;IS  THE  NEXT  CONTROL  CHAR  AN  INP  OR  OUT? 

LDAA 

0.X 

.GET  THE  CONTROL  CHAR 

ANDA 

#$F0 

;  AND  CHECK  THE  HIGH  NIBBLE 

CMPA 

#$90 

;IS  IT  AN  INPUT  TYPE? 

BNE 

TTYOL 

;IF  NOT,  SWITCH  TO  OUTPUT  MODE 

JMP 

SCIXIT 

.ELSE  GET  ANOTHER  CHAR 

* 

TTYOL: 

JMP 

TTYO 

LBISX: 

LDAB 

o,x 

.SUBROUTINE  TO  LOAD  B.  INC  A  STR  X 

INX 

;  USED  BY  TTY  ABOVE 
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STX 

XTTY 

RTS 

CRADDR: 

LDX 

#$0000 

;SUBROUTINE  TO  CREATE  AN  ADDRESS 

ABX 

RTS 

;  AFTER  VALID  ADDRESS,  RECEIVE 


CONCHAR: 

ANDA 

#$7F 

CMPA 

#'!' 

BEQ 

SETBG 

CMPA 

#'?' 

BEQ 

SETQG 

CMPA 

#'0' 

BEQ 

TIMEJ 

CMPA 

#*F 

BEQ 

TIMOUTJ 

CMPA 

#'-’ 

BEQ 

DSCANL 

CMPA 

#'A’ 

BEQ 

ATTCMD 

CMPA 

#" 

BEQ 

GOMON 

CMPA 

#$0D 

BEQ 

GOMON 

CMPA 

#’H' 

BEQ 

SAYHEL 

CMPA 

WR' 

BEQ 

RSTARTJ 

CMPA 

#*V' 

BEQ 

AVOUTJ 

JMP 

SETUNAD 

GOMON: 

JMP 

PROMPT 

SAYHEL: 

JMP 

SAYHELP 

DSCANL: 

JMP 

DSC  AN 

TIMEJ: 

JMP 

TIME 

TIMOUTJ: 

JMP 

TIMOUT 

RSTARTJ: 

JMP 

START 

AVOUTJ: 

JMP 

AVOUT 

SETBG: 

LDD 

#BGROUP 

JMP 

RSET 

SETQG: 

LDD 

#QGROUP 

JMP 

RSET 

ATTCMD: 

LDD 

#ATTNGRP 

JMP 

RSET 

BGROUP: 

NOP 

CMPA 

#T 

BEQ 

LTESTJ 

CONTROL  CHAR.. 

•.CLEAN  OFF  FLAG  BIT 
;IS  IT  V 

;OR  IS  IT  T 

;IS  IT  O’,  START  DATA  COLLECTION? 
;IS  IT  V,  PAUSE  DATA  COLLECTION? 
;IS  IT  DATA  SCAN  REQUEST? 

;IS  IT’A*,  SET  GAIN  CONTROL? 

.SPACE  TO  ENTER  MONITOR? 

.CHAR  RETURN  TO  ENTER  MONITOR? 
.HELP? 

.RESTART? 

;ATTEN  VALUE  REQUEST 

;UN ADDRESS  IF  NOT  VALID.. 

.LINK  INTO  MONITOR 

-.LINK  TO  SAYHELP 

;LINK  TO  DATA  SCAN 

.LINK  TO  TIME 

;LINK  TO  TIMOUT 

;LINK  TO  START 

•.LINK  TO  ATTEN  VAL  OUTPUT 

.PREPARE  FOR  THE  CHAR  AFTER  ! 

.PREPARE  FOR  THE  CHAR  AFTER  ? 

•.PREPARE  FOR  THE  CHAR  AFTER  A 
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if  LOAD 

CMPA  #M’ 

BEQ  BANGML 
endif 

JMP  PROMPT 

9 

if 

LOAD 

BANGML: 

JMP 

BANGM 

.LINK  TO  IM 

LTESTJ: 

else 

endif 

JMP 

LTEST 

QGROUP: 

NOP 

if 

CMPA 

BEQ 

else 

endif 

JMP 

VIEW 

QUERYML 

PROMPT 

9 

if 

VIEW 

QUERYML: 

JMP 

QUERYM 

;LINK  TO  ?M 

else 

endif 

ATTNGRP:  NOP 

CMPA 

#W 

BEQ 

SETODBJ 

CMPA 

rr 

BEQ 

SET1DBJ 

CMPA 

#'2' 

BEQ 

SET2DBJ 

CMPA 

rr 

BEQ 

SET3DBJ 

CMPA 

#'4' 

BEQ 

SET4DBJ 

CMPA 

#•5’ 

BEQ 

SET5DBJ 

CMPA 

#’6' 

BEQ 

SET6DBJ 

CMPA 

Hf’A' 

BEQ 

AGCONJ 

JMP 

PROMPT 

SETODBJ 

JMP 

SETODB 

SET1DBJ 

JMP 

SET03DB 

SET2DBJ 

JMP 

SET09DB 

SET3DBJ 

JMP 

SET12DB 

SET4DBJ 

JMP 

SET18DB 

SET5DBJ 

JMP 

SET24DB 

•.MANUAL  SET  0  DB  ATTEN 
;MANUAL  SET  3  DB  ATTEN 
MANUAL  SET  9  DB  ATTEN 
MANUAL  SET  12  DB  ATTEN 
MANUAL  SET  18  DB  ATTEN 
;  MANUAL  SET  24  DB  ATTEN 
MANUAL  SET  30  DB  ATTEN 
;SET  AGC  ON 


;LINK  TO  SETODB 
•.LINK  TO  SET3DB 
•.LINK  TO  SET09DB 
.LINK  TO  SET12DB 
.LINK  TO  SET18DB 
XINK  TO  SET24DB 
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SET6DBJ: 

JMP 

SET30DB 

.LINK  TO  SET30DB 

AGCONJ: 

JMP 

AGCON 

;LINK  TO  AGCON 

[pause  REQUEST 
TIMOUT:  CLR 

TMSK1 

STOPS  THE  DATA  DUMP 
;DISABLE  TOC2  INTERUPT 

LDAA 

#SFF 

;RESET  TOC  FLAGS 

STAA 

TFLG1 

JMP 

PROMPT 

•.RETURN 

•.START  REQUEST 
TIME:  LDD 

TCNT 

TURN  ON  TIMER  INTERUPT 
.LOAD  THE  CURRENT  TIMER  VALUE 

ADDD 

^SAMPLE 

;SET  AN  INITIAL  DELAY  OF  l.OmSEC 

STD 

DTOC2 

LDAA 

#S40 

;TURN  ON  OC2  INTERUPT 

STAA 

TMSK1 

JMP 

PROMPT 

■.RETURN 

;  DATA  SCAN 
DSC  AN: 

LDX 

#DSCAN0 

JMP 

TTYO 

DSCANO: 

DB 

SAA 

DW 

DSC  AN  1 

DSCAN1: 

BRCLR  TX1FLG.S01.DSCAN2  ;HAS  BUFFER  1  BEEN  SENT  YET? 
BRCLR  TX2FLG.S0 1 .DSC  AN3  ;HAS  BUFFER  2  BEEN  SENT  YET? 

NOTYET: 

LDX 

#NOTRDY 

.WAIT  UNTIL  A  BUFFER  IS  READY 

JMP 

TTYO 

NOTRDY: 

FCB 

S00.S00 

DSCAN2: 

BSET 

TX1FLG.S01 

.SET  BUFFER  1  TXD  FLAG 

LDX 

#MAXBUF1 

BRA 

DSCAN4 

DSCAN3: 

BSET 

TX2FLG.S01 

.SET  BUFFER  2  TXT)  FLAG 

LDX 

#MAXBUF2 

DSCAN4: 

STX 

TXBUFF 

-.SAVE  THE  BUFFER  TO  TX  IN  TXBUFF 

LDAB 

ABX 

MAXNUM 

STX 

TXBFULL 

.GENERATE  THE  BUFFER  DONE  VALUE 

» 

LDY 

TXBUFF 

STY 

TXINT 

DSCAN5: 

LDAA 

$00, Y 

;GET  THE  DATA  POINT  HI  BYTE 

STAA 

TXMHI 

•.STORE  IN  BASE  PAGE 

LDAA 

$01,  Y 

;GET  THE  DATA  POINT  LOW  BYTE 

STAA 

TXMLO 

;STORE  IN  BASE  PAGE 

LDAA 

$10,Y 

;GET  THE  INDEX  HI  BYTE 

STAA 

TXIHI 

LDAA 

$1 1,Y 

;GET  THE  INDEX  LOW  BYTE 

STAA 

TXILO 

* 

LDX 

#BITSND1 

;PREP  FOR  TX 
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JMP 

TTYO 

;TX  DATA  POINT 

BITSNDl: 

DB 

S81.TXMHI.SAA 

;TX  VIA  TTY 

DW 

DTX1 

DTX1: 

LDX 

#BITSND2 

;PREP  FOR  TX 

JMP 

TTYO 

;TX  DATA  POINT 

BITSND2: 

DB 

$8 1  ,TXMLO,$AA  ;TX  VIA  TTY 

DW 

DTX2 

DTX2: 

LDX 

#BITSND3 

;PREP  FOR  TX 

JMP 

TTYO 

;TX  DATA  POINT 

BITSND3: 

DB 

S81.TXIHI.SAA 

;TX  VIA  TTY 

DW 

DTX3 

DTX3: 

LDX 

#BITSND4 

•J'REP  FOR  TX 

JMP 

TTYO 

;TX  DATA  POINT 

BITSND4: 

DB 

S81.TXILO.SAA 

;TX  VIA  TTY 

DW 

DSCAN6 

DSCAN6: 

LDY 

TXINT 

INY 

INY 

STY 

TXINT 

CPY 

TXBFULL 

;HAS  THE  ENTIRE  BUFFER  BEEN  SENT? 

BLO 

DSCAN5 

9 

LDAA 

#soo 

LDX 

TXBUFF 

.CLEAR  THE  BUFFER  THAT  WAS  TXT) 

DSCAN7: 

STAA 

S00.X 

INX 

CPX 

TXBFULL 

BLO 

DSCAN7 

• 

LDX 

#DSCAN8 

;END  TX 

JMP 

TTYO 

DSCAN8: 

DB 

$00,S00 

LTEST: 

LDX 

ORTEST 

JMP 

TTYRO 

9 

RTEST: 

9 

DB 

S94.S80,"  GOT  4!  SEND  4  MORE’,$EE1$94^84,*DONE*,$00,$00 

0  DB  MANUAL  GAIN  REQUEST 


SETODB: 

BSET 

LDAA 

STAA 

JMP 

AGCFLG.S01 

#DB00 

PORTA 

PROMPT 

;TURN  OFF  AGC 

;SET  0  DB  ATTENUATION 

.RETURN 

;3  DB  MANUAL  GAIN  REQUEST 

SET03DB: 

BSET 

AGCFLG^Ol 

;TURN  OFF  AGC 

LDAA 

#DB03 

;SET  3  DB  ATTENUATION 

STAA 

PORTA 

JMP 

PROMPT 

•.RETURN 
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;9  DB  MANUAL  GAIN  REQUEST 

SET09DB:  BSET  AGCFLG.S01  .TURN  OFF  AGC 

LDAA  #DB09  ;SET  9  DB  ATTENUATION 

STAA  PORTA 


JMP 

PROMPT 

•.RETURN 

;12  DB  MANUAL  GAIN 
SET12DB:  BSET 

LDAA 
STAA 
JMP 

REQUEST 

AGCFLG.S01 

#DB12 

PORTA 

PROMPT 

;TURN  OFF  AGC 

.SET  12  DB  ATTENUATION 

•.RETURN 

;18  DB  MANUAL  GAIN 

REQUEST 

SET18DB:  BSET 

AGCFLG.S01 

;TURN  OFF  AGC 

LDAA 

#DB18 

;SET  18  DB  ATTENUATION 

STAA 

PORTA 

JMP  PROMPT  ;RETURN 
;24  DB  MANUAL  GAIN  REQUEST 


SET24DB: 

BSET 

LDAA 

STAA 

JMP 

AGCFLG.S01 

#DB24 

PORTA 

PROMPT 

;TURN  OFF  AGC 

;SET  24  DB  ATTENUATION 

-.RETURN 

;30  DB  MANUAL  GAIN  REQUEST 
SET30DB:  BSET  AGCFLG.S01 

LDAA  «DB30 

STAA  PORTA 

JMP  PROMPT 

;TURN  OFF  AGC 

;SET  30  DB  ATTENUATION 

.RETURN 

■AGC  ON  REQUEST 

AGCON: 

CLR 

AGCFLG 

;SET  AGC  ON  FLAG  TO  0  (TURN  AGC  ON) 

JMP 

PROMPT 

;RETURN 

AVOUT: 

LDX 

#AVODAT 

JMP 

TTYO 

AVODAT: 

DB 

S81,  PORTA,  S00,$00 

* 

JMP 

PROMPT 

;  HELP  FILE 
HELPFIL  :FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 


’elp  SAIL  DRIVER  Mon,  Jun  7,  1993,  1  l:53',SOD,$OA 
Monitor  Commands  (enter  via  _  or  ?  or  !)\$0D,$0A 
'  _  (space)  enter  monitor* ',$0D,$0  A 
'  ?Maaaa  Jlllcr  *’,$0D,$0A 
’  !Maaaa_dd...cr  *',S0D,$0A 
'Attenuator  Commands  (enter  via  A)',$0D,$0A 
'  AO  sets  0  dB  manual  attenuation',$OD,$OA 
'  A1  sets  3  dB  manual  attenuation',SOD,SOA 
'  A2  sets  9  dB  manual  attenuation',SOD,$OA 
'  A3  sets  12  dB  manual  attenuation', SOD^OA 
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FCB  '  A4  sets  18  dB  manual  attenuation',$OD,$OA 

FCB  '  AS  sets  24  dB  manual  attenuation',$OD,$OA 

FCB  '  A6  sets  30  dB  manual  attenuation'>S0D>$0A 

FCB  '  AA  turns  AGC  on',$0D,S0A 

FCB  'O  starts  receiver  collecting  samples',$0D,$0A 

FCB  T  pauses  receiver',$0D,$0A 

FCB  *R  resets  the  system', SOD, $0A 

FCB  *with  all  RCA  UT4  conventions',$0D,$0A 

FCB  '  *  returns  prompt', $00 


ORG  SFFD6 


VSCI: 

FDB 

SCI 

VSPI: 

FDB 

START 

VPAIE: 

FDB 

START 

VPAO: 

FDB 

START 

VTOF: 

FDB 

START 

VTOC5: 

FDB 

START 

VTOC4: 

FDB 

START 

VTOC3: 

FDB 

START 

VTOC2: 

FDB 

OC2 

VTOC1: 

FDB 

START 

VTIC3: 

FDB 

START 

VTIC2: 

FDB 

START 

VTIC1: 

FDB 

START 

VRT1: 

FDB 

START 

VIRQ: 

FDB 

START 

VXIRQ: 

FDB 

START 

VSW1: 

FDB 

START 

VILLOP: 

FDB 

START 

VCOP: 

FDB 

START 

VCLM: 

FDB 

START 

VRST: 

FDB 

START 

END 
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Appendix  3 


This  appendix  contains  the  C  source  code  use  by  the  Macintosh  computer  for 
the  algorithm  of  figure  2-4.  The  user  interface  follows  the  guidelines  specified  by 
Apple,  and  the  Event  Manager  is  used  to  initiate  all  functions.  After  the  hardware  is 
initialized,  the  program  waits  in  the  EventLoop  until  an  event  is  received.  If  no  events 
are  received  in  the  loop  cycle  time,  the  program  requests  data  from  the  68HC11  and 
the  GPS  receiver.  If  the  data  is  available,  it  is  stored  to  form  experiment  vectors. 

Once  enough  experiment  vectors  are  collected,  the  maximum  likelihood  estimate  is 
calculated.  The  program  the  returns  to  the  EventLoop. 

TRACKER.C 

Dennis  Michael  Wojcik 
15  July  1993 

This  program  is  version  1.0  of  the  Precision  Tracking  Receiver.  It  is  tailored 
for  the  scenario  of  a  stationary  acoustic  beacon  and  a  moving  observer.  The 
program  assumes  that  the  observer  has  a  GPS  receiver  for  positioning  data 
that  can  produce  a  fix  at  least  every  2  seconds.  If  a  different  navigation 
system  is  used  to  provide  ship  locations,  it  is  up  to  the  user  to  provide 
the  proper  position  format: 

?L  HHMMSS,DDMM.hh,N,DDDMM.hh,E,x,x,DOP,xxx,Mrxxxxx,M 


'/ 


/**********•*******•*♦******  INCLUDES  *••♦*••***••***••****♦*******••****•♦♦**/ 

((include  <math.h>  //  needed  for  math  calls 

((include  <AppleEvents.h>  //  needed  to  handle  AppleEvents 

((include  <GestaltEqu.h>  //  needed  to  read  system  7  AppleEvents 

((include  <Values.h>  //  contains  needed  Mac  constants 

((include  <serial.h>  //  has  needed  serial  comms  constants 

((include  <Packages.h>  //  needed  to  call  time  functions 

((include  <string.h>  //  needed  to  call  string  functions 

((include  <float.h>  //  contains  needed  constants 

((include  <stdlib.h>  //  for  standard  calls  such  as  strtoul  etc 

((include  <stdio.h>  //  usefull  for  debugging 

. . . . . . . . 


*♦  DEFINES  *♦****••♦* 

^define  kBaseResID 

128 

//  define  general  resource  infor 

#define  kMoveToFront 

(WindowPtr)-lL 

fldefine  kUseDefaultProc 

(void  *)-lL 

^define  kSleep 

1L 

#  define  kLeaveWhereltls 

false 

^define  mApple 

kBaseResID 

//  Apple  menu  resource  ID 

^define  iAbout 

1 

^define  mFile 

kBaseResID+1 

//  File  menu  resource  ID 

^define  iQuit 

1 

^define  mAttenuator 

kBaseResID+3 

//  Attenuator  menu  resource  ID 

^define  iAuto 

1 

^define  iOdB 

2 

^define  i3dB 

3 

^define  i9dB 

4 

^define  il2dB 

5 

# define  il8dB 

6 

^define  i24dB 

7 

#  define  i30dB 

8 

^define  mBaud 

kBaseResID+4 

//  Baud  Rate  menu  resource  ID 

^define  i3 00 

1 

^define  i600 

2 

^define  il200 

3 

^define  i2400 

4 

^define  i4800 

5 

#define  i9600 

6 

^define  mSignal 

kBaseResID+5 

//  Signal  menu  resource  ID 

^define  iPeriod 

1 

Adeline  iNumMax 

2 

Adeline  iWindow 

3 

Adeline  iMessageText 

4 

Adefine  kPeriodDialog 

kBaseResID 

#define  kNumMaxDialog 

kBaseResID+1 

Adefine  kWindowDialog 

kBaseResID+2 

Adefine  kLeflMargin 

4 

//  define  screen  margins 

Adefine  kFontSize 

10 

Adefine  kRowHeight 

(kFontSize+2) 

Adefine  kDataScanHeight 

1 

Adefine  kHorizontalOffset 

0 

Adefine  kGestaltMask 

1L 

Adefine  kHorizontalPix 

30 

Adefine  kVerticalPix 

40 

Adefine  kMinWindowHeight 

50 

Adefine  kMinWindowWidth 

80 

Adefine  kMinTextPosition 

0 
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#  define  kMaxTextPosition 

32767 

^define  kScrollbarAdjust 

(16-1) 

//  define  update  constants 

^define  kNormalUpdates 

true 

^define  bufferSize 

1024 

//  misc.  default  values 

^define  kl6Bit 

4 

^define  k8Bit 

2 

#  define  kHexBase 

16 

#  define  kpi 

3.141592654 

^define  kNumExp 

6 

//  default  experiment  parameters 

^define  kParameters 

3 

^define  kNumMeas 

6 

^define  kStep 

15 

^define  kC 

1500 

^define  kMaxR 

5000.0 

^define  kMaxD 

-5000.0 

^define  kMinD 

-1.0 

^define  kxvar 

9.0 

^define  kyvar 

9.0 

fldefine  ktvar 

8.3333e-2 

. . .MMMM.M.MM  MACROS  ••♦••*******•**♦♦•***•♦*♦••**♦♦♦•*♦*••***•/ 


^define  TopLeft(  r  ) 

(♦(Point  •)  A(r).top) 

^define  BottomRight(  r  ) 

(♦(Point  *)  &(r) .bottom) 

***  GLOBALS  ♦♦♦*•*♦••♦•**♦•••♦**♦♦♦*♦ 

int 

gASerRefln,  gASerRefOut; 

Boolean 

gDone,  gHasPopupControI,  gDataScan; 

Rect 

gTrackerRect; 

int 

gverticalPixels; 

int 

gRowStart,  gDataRowStart,  gserConfig; 

unsigned  long 

gPeriod=2000UL; 

long 

gNumMax=2L,  gWindow=20L; 

char 

gDataBufferfbufferSize] ; 

char 

gGPSBuffer[bufferSize]= 

"L  1 45642,0000.00 J4,00000.00,E, 

short 

gLastAttn=l,  gLastBaud=6; 

Str255 

gltemText; 

unsigned  long 

ghorizontalPixels; 

WindowPtr 

gWetPaperWind,  gTerminalWind,  gRange 

long 

gPulseCounter=0L; 

long 

gCheckVal=lL; 

unsigned  long 

gtimel,  gtime2; 

double 

gXref,  gYref,  gXl,  gX2,  gYl,  gY2; 

Boolean 

gstarter=tnie; 
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Boolean  greflag=true; 

Boolean  gDataWrap=false,  trackerStart=false; 

double  gYFact; 

unsigned  long  gt_mul,  gt_mu2; 

double  gV[kNumMeas]={kxvarJtyvar4ctvarJcxvarJcyvarJctvar}; 

double  gtheta[3]={  0.0,  0.0,  -2000.0},  gPosition[kParameters]; 

double  *gw; 

double  gxold=0.0,  gyold=0.0; 

int  gnumlts=0; 

int  gmu=0; 

long  gi=0L,gnumExp=0L; 

double  gj=1.0; 

char  gYrefString[8]; 

char  gXrefString[9]; 

/*************************  FUNCTION  prototypes************** 

void  ToolBoxInit(void); 

void  Windowlnit(void); 

void  MenuBarlnit(void); 

void  SerialInit(void); 

void  EventLoop(void); 

void  DoEvent(  EventRecord  *eventPtr  ); 

unsigned  long  HandleDataIn(int  numDataPoins); 

void  HandleMouseDown(EventRecord  *eventPtr); 

void  HandleMouseUp(EventRecord  *eventPtr); 

void  HandleMenuChoice(  long  menuChoice  ); 

void  HandleAppl«*Choice(  short  item  ); 

void  HandleFileChoice(  short  item  ); 

void  HandleAttenuator(short  item); 

void  HandleBaud(short  item); 

void  HandleSignal(short  item); 

unsigned  long  HandleDialog(int  dialogRes); 

void  ConcatString(Str2SS  strl,  Str255  str2); 

void  HandleKeyIn(  char  theChar); 

int  TalkSail(  char  theChar); 

void  DisplayString(int  numDataPoints); 

void  ScrollDisplay(void); 

void  HandleNull(  void  ); 

unsigned  HexCharToInt(char  Bite, int  exponent); 

int  DecIntToHexChar(int  decimal); 

void  DoUpdate(EventRecord  *eventPtr); 

int  Power(int  base,  int  exponent); 

int  DecIntToHexChar(int  decimal); 

void  ScrollDataScan(void); 

unsigned  long  DecTimeToSec(unsigned  long  timeVal); 

double  LatToY(double  latVal); 

double  LongToX(double  longVal,  double  cosfact); 

void  trackerOong  numExp); 

pascal  OSErr  SetDialogDefaultItem(DialogPtr  theDialog,  short  newltem) 
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={  Ox303C,  0x0304,  0xAA68}; 

pascal  OSErr  SetDialogCancelItem(DialogPtr  theDialog,  short  newltem) 

={0x303C,  0x0305,  0xAA68}; 

pascal  OSErr  SetDialogTracksCursor(DialogPtr  theDialog,  Boolean  tracks) 


={0x303C,  0x0306.  0xAA68}; 

/*•*•* . * . * . * . . . . 

/* - Main - *■' 

void  main(void) 

{ 

WindowPtr  window; 

OSErr  RAMOpenErr,  resetErrln,  resetEnOut,  bufSizeErr, 

int  SerConfig; 

Ptr  serBPtr, 

char  serlnBufferfbufferSize]; 

long  numCharln,  numCharOut,  maxtime; 

char  addressBuf|20]; 

ToolBoxInitO;  //  initialize  the  toolboxes 

WindowInitO;  »  set  up  the  windows 

MenuBarlnitO;  H  dr»w  the  menu  bar 

SeriallnitQ;  //  open  the  serial  drivers 


window=FrontWindowO;  //  ensure  we’re  in  the  window 

RAMOpenErr=RAMSDOpen(sPortA);  //  open  the  RAM  Serial  Drivers 

if  (RAMOpenErr  !=  noErr)  //  if  we  cant  open  RAM  Driver  beep 

{ 

SysBeep(10); 

ScrollDisplayO; 

DrawString("\pProblem  opening  the  RAM  Serial  Drivers."); 

} 

gserConfig=baud9600+data8+stop  1 0+noParity ;  //  Set  the  protocal  for  9600 

//  8  data,  1  stop,  no  parity 

resetErrIn=SerReset(gASerRefIn,gseiConfig); 

resetErrOut=SerReset(gASerRefOut,gserConfig); 

if  ((resetErrln  !=  noErr)  ||  (resetEnOut  !=  noEn)) 

{ 

SysBeep(10);  H  if  we  cant  set  u.e  protocal 

ScrollDisplayO;  //  beep 

DrawString("\pProblem  setting  the  serial  protocal."); 

} 

serBPtr=serInBuffer;  H  Set  the  serial  buffer  size 

bufSizeErr=SerSetBuf(gASerRefln,  serBPtr  .bufferSize); 
if  (bufSizeErr  !=  noEn) 

{ 

SysBeep(10);  //  if  we  cant  set  the  buffer 

ScrollDisplayO;  H  size,  beep 

DrawString("\pProblem  resizing  the  serial  input  buffer."); 

} 

ScrollDisplayO; 
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numCharOut=5L;  II  see  if  we  can  talk  to  the  GPS  receiver 

FSWrite(pASerRefOut,  &numCharOut,  "#GPS  "); 

SerGetEuf(gASerRefln,&numCharIn); 
maxtime=TickCountO+20L; 
whilefnumCharln  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO  >  maxtime) 

{ 

SysBeepflO); 

DrawString("\p  Can't  talk  to  the  GPS  reciever,  uiable  to  run!!’); 

ScrollDisplayO; 

break; 

} 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numCharOut=5L;  II  see  if  we  can  talk  to  the  PTR  receiver 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefln,&numCharIn); 
maxtime=T  ickCountO+20L ; 
whilefnumCharln  <  9L) 

SerGetBuf(gASerRefln,&numCharIn); 
iffTickCountO  >  maxtime) 

{ 

SysBeep(lO); 

DrawString("\p  Can't  talk  to  the  PTR  reciever,  unable  to  run!!’); 

ScrollDisplayO; 

maxtime=TickCountO+ 1 20L; 

whilefTickCountC  <  maxtime) 

TickCountO; 

abortO; 

} 

} 

FSRead(gASerRefln,&numCharIn,&addressBuf); 

TalkSailCO*);  II  start  the  PTR's  data  collecticn 

DrawString("\p:  ");  //  display  a  cursor 

gw  =  calloc(3L*kStep*(kNumExp+l),sizeof(double));  II  get  memory  for  data 
if  (gw  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

EventLoopO;  //  main  execution  loop 

RAMSDClose(sPortA);  //  must  close  the  RAM  Drivers  before  shutdown 


193 


} 

/*- 


free(gw); 


//  must  release  the  memory  before  shutdown 


- */ 


/• - ToolBoxInit - •/ 

void  ToolBoxInit(void) 

{  //  initialize  all  of  the  ToolBox 

InitGraf(&thePort);  //  Routines 

InitFontsO; 

InitWindowsO; 

InitMenusO; 

TEInitO, 

InitDialogs(nil); 

InitCursorO; 

} 

/* - */ 


!• - Windowlnit - */ 

void  Windowlnit(void) 

{  //  initialize  the  display  windows 

WindowPtr  window; 

short  fontNum; 

Boolean  update  =  true; 

window  =  GetNewWindowfkBaseResID,  nil,  kMoveToFront); 

if  (window  =  nil) 

{ 

SysBeep(lO);  //  Couldn’t  load  the  WIND  resource 

ExitToShellO; 

} 

SetPort(window);  //  set  the  window  to  be  active 

GetFNum("\pT imes" ,  AfontNum);  //  use  Times  font 

if  (fontNum  !=  0)  TextFont(fontNum); 

TextSize(kFontSize);  //  use  the  default  font  size 

gverticalPixels=screenBits.bounds.bottom-screenBits.bounds.top-45; 

ghorizontalPixels=screenBits.bounds.right-screenBits.bounds.left-10; 

gDataRowStart=gverticalPixels-2*kFontSize; 

SizeWindow(window,  ghorizontalPixels,  gverticalPixels,  update); 

ShowWindow(window);  II  activate  the  window 

gWetPaperWind«FrontWindow(); 

gTerminalWind  *  GetNewWindow(kBaseResII>H ,  nil,  kMoveToFront); 
if  (gTerminalWind  =  nil) 
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{ 

SysBeep(10);  //  Couldn't  load  the  WIND  resource 

ExitToShellO; 

} 

SetPort(gTerminalWind);  //  set  the  window  to  be  active 

GetFNum("\pT imes" ,  &fontNum);  //  use  Times  font 

if  (fontNum  !=  0)  TextFont(fontNum); 

TextSize(kFontSize);  //  use  the  default  font  size 

gRowStart=gTerminalWind->portRect.botiom-2*kFontSize; 

ShowWindow(gTerminalWind); 

} 

/* - */ 


- MenuBarlnit - */ 

MenuBarlnit(void) 

Handle  menuBar; 

MenuHandle  menu; 

menuBar  =  GetNewMBar(  kBaseReslD  ); 

SetMenuBar(  menuBar  ); 

menu  =  GetMHandle(  mApple  ); 

AddResMenu(  menu,  DRVR1); 

DrawMenuBarO; 

} 

/* - */ 


/* - Seriallnit - */ 

void  Seriallnit(void) 

{ 

WindowPtr  window; 

OSErr  openErr,  RAMErr,  resetErr  ; 

int  seTConfig; 

char  driverStringInn="\p.AIn"; 

char  driverStringout[]»"\p.Aout"; 

window=FrontWindowO; 

openErr=OpenDriver(driverStringIn,&gASerRefIn);  //  Open  the  port  A  ROM  input  serial  driver 
if  (openErr  1=  0) 

< 

SysBeep{10); 

ScrollDisplayO; 

DrawString("\pCan’t  open  the  ROM  Serial  input  driver"); 
return; 


//  define  system  errors 
II  define  the  port  configuration 
II  define  the  input  driver  name 
//  define  the  output  driver  name 


void 

{ 


195 


} 

openErr=OpenDriver(driverStringout,&gASerRefOut);  //  Open  the  port  A  ROM  output 

//serial  driver 

if  (openErr  !=  0) 

{ 

SysBeep(10); 

ScrollDisplayO; 

DrawString("\pCan't  open  the  ROM  Serial  output  driver*); 
return; 

} 

gserConfig=baud9600+data8+stopl0+noParity;  //  Set  the  protocal  for 

//  9600,  7D,  IS,  no  parity 

resetErr=SerReset(gASerRefln,gserConfig);  //  Set  the  input  driver  to  the  new  protocal 

if  (resetErr  !=  0) 

{ 

SysBeep(10); 

ScrollDisplayO; 

DrawString("\pCan't  set  the  ROM  Serial  input  protocal"); 
return; 

} 

resetErr=SerReset(gASerRefOut,gserConfig);  //  Set  the  output  driver  to  the  new  protocal 
if  (resetErr  !=  0) 

{ 

SysBeep(10); 

ScrollDisplayO; 

DrawString("\pCan't  set  the  ROM  Serial  output  driver"); 
return; 

} 


} 

/* - */ 


/• - EventLoop - */ 

void  EventLoop(void) 

{ 

EventRecord  event; 
gDone  =  false; 

while  (gDone  =  false)  //  loop  here  until  done  with  program 

{ 

if  (WaitNextEvent(every Event,  &event,  kSleep,  nil)) 

DoEvent(&event); 

else 

HandleNullO;  //  collect  data  here 

} 

} 

/* - ./ 
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/* - DoEvent - ■•/ 

void  DoEvent(EventRecord  *eventPtr) 

{ 

Boolean  becomingActive; 

char  theChar; 

switch  (eventPtr->what) 

{ 

case  mouse  Down: 

HandleMouseDown(eventPtr); 
break; 
case  mouseUp: 

HandleMouseUp(eventPtr); 
break; 
case  keyDown: 

theChar  =  eventPtr->message  &  charCodeMask; 
if((eventPtr->modifiers  &  cmdKey)  !=  0) 

HandleMenuChoice(MenuKey(  theChar)); 

else 

HandleKeyIn(  theChar  ); 

break; 
case  updateEvt: 

DoUpdate(  eventPtr); 
break; 

/*  case  activateEvt: 

becomingActive  =  ((eventPtr->modifiers  & 

activeFlag)  == 
activeFlag); 

DoActivate((WindowPtr)eventPtr->message, 

becomingActive); 

break;*/ 

} 

} 


/* - HandleNull - V 


HandleNull(void) 

int 

numGPSPoints; 

int 

numDataPoints; 

int 

GPSbufT; 

long 

numCharOut,  numCharln,  numCharlnOld; 

char 

addressBuf[bufferSize]; 

char 

*tok; 

char 

•timeOfRx; 

char 

♦latitude; 

char 

♦longitude; 

char 

•HDOP; 

char 

*delim=" 

char 

♦end; 
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int 

i; 

unsigned  long  int 

timeVal; 

double 

latVal,longVal,HDOPVal; 

double 

cosfact; 

unsigned  long 

t_mu; 

long 

maxtime; 

Str255 

numstr; 

char 

*lattest="  1234.89*; 

double 

lattestd,  dl; 

long 

lattestdec.lattestr; 

double 

timemod; 

if  (gDataScan  ==  true) 

{ 

/* — >  use  this  part  when  the  GPS  receiver  is  available 
numCharOut=5L; 

FSWrite(gASerRefOut,  AnumCharOut,  "#GPS  "); 
SerGetBuffgASerRefln.AnumCharln); 
maxtime=TickCountf)+20L; 
whilefnumCharln  <  9L) 

{ 

SerGetBuffgASerRefln,AnumCharIn); 
if(TickCountO  >  maxtime)  break; 

} 

FSRead(gASerRefln,AnumCharIn,AaddressBuf); 

numCharOut=2L; 

FSWrite(gASerRefOut,  AnumCharOut,  "?L"); 
SerGetBuffgASerRefln.AnumCharln); 
maxtime=TickCountf)+20L; 
whilefnumCharln  <  55L) 

{ 

SerGetBuffgASerRefln,AnumCharIn); 
iffTickCountf)  >  maxtime)  break; 

} 

FSReadfgASerRefln.AnumCharln.AgGPSBufTer); 


numCharOut=5L; 

FSWritefgASerRefOut,  AnumCharOut,  *#PTR  "); 
SerGetBuffgASerRefln.AnumCharln); 
maxtime=TickCountO+20L; 
whilefnumCharln  <  9L) 

{ 

SerGetBuffgASerRefTn.AnumCharln); 
iffTickCountO  >  maxtime)  break; 

} 

FSReadfgASerRefln.AnumCharln.AaddressBuf); 

numDataPoints=TaIkSaiIC-’); 
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if(numDataPoints  >  5) 

{ 

gPulseCounter++; 

tok=strtok(gGPSBuffer,deHm); 

timeOfRx=strtok(NULL  ,delim); 

latitude=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

longitude=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

tok=strtok(NULL,delini); 

HDOP=strtok(NULL  ,delim); 

time  Val=strtoul(timeOfRx,&end,  1 0); 
latVal=strtod(latitude,&end); 
longVal=strtod(longitude,&end); 
HDOPVal=strtod(HDOP,&end); 


if  (HDOPVal  <  10.0) 

{ 

if  (gstarter  ==  true) 

t_mu=HandleDataIn(numDataPoints); 

gtime2=DecTimeToSec(timeVal); 

gX2=0.0; 

gY2=0.0; 

if  (greflag  ”  true) 

{ 

gYref=LatToY(latVal); 

gYFact=eos((gYref/(I853.2*60.0))*kpi/180.0); 

gXref=LongToX(longVal,gYFact); 

greflag=false; 

} 

gstarter=false; 

} 

else 

{ 

t_mu=HandleDataln(numDataPoints); 

/*...>  use  this  if  GPS  availble  to  see  if  fixes  are  2  sec  apart 


•/ 


if(DecTimeToSec(timeVal)  !=  gtime2-2UL) 
if(DecTimeToSec(timeVal)  !=  gtime2) 


{ 

gstarter=true; 

} 

else 

gtimel=gtime2; 

gtime2=DecTimeToSec(timeVal); 
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gXl=gX2; 

gX2=LongToX(longVal,gYFact)-gXref; 

gYl-gY2; 

gY2=LatT  oY  (latV  al)-g  Yref; 


//— >  make  up  data  to  test  program 


//--->  end  of  simulated  data 
/* — >use  this  if  GPS  available 


*/ 


gw[gi]=gxold+cos(0.00515*gj)*5. 14778; 
gw[gi+l]=gyold+sin(0.00515*gj)*5. 14778; 

gxold=gw[gi); 

gyold=gw[gi+ll; 

gj=gj+1.0; 

d  1  =sqrt((gxold- 1 000)*(gxold- 1000) 

+(gyold-2000)*(gyold-2000)+3000*3000); 
timemod=dl/1.5; 
while(timemod  >  2000.0) 

timemod=timemod-2000.0; 

gw[gi+2]=timemod; 


gw[gi]=(  1 ,0-t  mu/((gtime2-gtime  1 )*  1 000.0)*gX  1 
+gX2; 

gw[gi+l]=(1.0-t  mu/((gtime2-gtime  1 )*  1000.0)*g Y 1 
+gY2; 

gw[gi+2]=t_mu; 


gi=gi+3L; 

if(gi  >=  3L*(kStep*kNumExp+lL)  ) 
trackerStart=tnie; 

if(gi  >=  3L*kStep*(kNumExp+lL)  ) 

{ 

gi=0L; 

gDataWrap=true; 

} 

if((trackerStart  —  true)  ||  (gDataWrap  ==  true)) 

{ 

tracker(gnumExp); 

} 


} 

} 

else 

{ 

t_mu=HandleDataIn(numDataPoints); 
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} 


} 


} 


} 


gstarter=tme; 


■*/ 


/* - DecTimeToSec - •/ 

unsigned  long  DecTimeToSec(unsigned  long  timeVal) 

{ 

unsigned  long  hr,  min,  sec,  timeSec; 

hr=timeVal/10000UL; 

min=(time  V  al-hr*  10000UL)/ 100UL; 

sec=time  Val-hr*  1  OOOOUL-min*  1 OOUL; 

timeSec=hr*  3600UL+min*60UL+sec; 

retum(timeSec); 

> 


/• - LongToX - */ 

double  LongToX(  double  longVal,  double  cosfactor) 

{ 

long  double  deg,  min,  X; 

deg=floor(longVal/l  00.0); 
min=(longVal-deg*  100.0); 

X=(deg*60.0+min)*1853.2*cosfactor, 

re  turn  (X); 

} 


/* - LatToY - */ 

double  LatToY(double  latVal) 

{ 

long  double  deg,  min,  Y; 

deg=floor(latVal/100.0); 
min=(latVal-deg*  100.0); 

Y=(deg*60.04min)*  1853.2; 

retum(Y); 
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/* - HandleMouseDown - */ 

void  HandleMouseDown(EventRecord  ‘eventPtr) 

{ 

WindowPtr  whichWindow; 

GrafPtr  oldPort; 

short  thePart; 

long  menuChoice; 

thePart  =  FindWindow(eventPtr->where,  AwhichWindow); 

switch(thePart) 

{ 

case  inMenuBar: 

menuChoice  =  MenuSelect(  eventPtr->where  ); 

HandleMenuChoice(  menuChoice  ); 

break; 

case  inSysWindow: 

SystemClick(eventPtr,  whichWindow); 
break; 
case  inContent: 

SetPort(whichWindow); 

GlobalToLocal(  Ac ventPtr-> where); 
break; 

case  inDrag: 

DragWindow(which Window,  eventPtr->where, 
&  sc  re  enBits. bounds); 

break; 

case  ir.GoAway: 

gDone  =  true; 
break; 

> 

} 


/• - HandleMouseUp- - •/ 

void  HandleMouseUp(EventRecord  *eventPtr) 

{ 

//  Put  some  function  in  here 

)  •/ 


/* - HandleMenuChoice - */ 

void  HandleMenuChoice(long  menuChoice) 

{ 

short  menu; 
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short 


item; 


if  (menuChoice  !=  0) 

{ 

menu=Hi  Word(menuChoice) ; 
item=LoWord(menuChoice); 

switch(menu) 

{ 

case  m Apple: 

HaudleAppleChoice(item); 
break; 
case  mFile: 

HandleFileChoice(item); 

break; 

case  mAttenuator: 

HandleAttenuator(item); 

break; 

case  mBaud: 

HandleBaud(item); 

break; 

case  mSignal: 

HandleSignal(item); 

break; 

} 

HiliteMenu(O); 

} 

/•  *1 


/* - HandleAppleChoice - */ 

void  HandleAppleChoicef  short  item  ) 

{ 

MenuHandle  appleMenu; 

Str255  accName; 

short  accNumber; 

switch(item) 

{ 

case  iAbout: 

Note  Alert  (kBaseResIDjiil); 
break; 

default: 

appleMenu  =  GetMHandle(mApple); 
GetltemfappleMenu,  item, accName); 
accNumber=OpenDeskAcc(accName); 
break; 

} 

} 

/• - */ 
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/* - - HandleFileChoice - */ 

void  Hai  <*'  FileChoice(short  item) 

{ 

switch(item) 

{ 

case  iQuit: 

gDone  =  true; 
break; 

} 

} 

/* - */ 


void 


numChaiOut=5L; 

FSWrite(gASerRefOut,  AnumCharOut,  "#PTR  *); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,AnumCharIn); 

} 

FSRead(gASerRefIn,AnumCharIn,AaddressBuf); 

numCharOut=2L; 

numCharIn=6L; 

menuHandle=GetMHandle(mAttenuator); 

CheckItem(menuHandle,gLastAttn,  false); 

CheckItem(menuHandle,item,true); 

gLastAttn=item; 

switch(item) 

case  iAuto: 

FSWrite(gASerRefOut,  AnumCharOut,  "AA"); 
break; 
case  iOdB: 

FSWrite(gASerRe(Dut,  AnumCharOut,  "AO"); 
break; 
case  i3dB: 

FSWrite(gASerRefDut,  AnumCharOut,  *A1'); 
break; 
case  i9dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A2*); 
break; 


- HandleAttenuator - */ 

HandleAttenuator(short  item) 

MenuHandle  menuHandle; 

long  numCharOut,  numCharln; 

char  attenBuff]  1 0] ,  addressBuf]  1 0] ; 


204 


case  il2dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A3"), 
break; 
case  il8dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A4"); 
break; 
case  i24dB: 

FSWrite(gASerRefOut,  AnumCharOut,  ’AS"); 
break; 
case  i30dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A6 "); 
break; 

} 

FSRead(gASerRefIn,  AnumCharln,  attenBufif); 


} 

/* - •/ 

/* - HandleBaud - */ 

void  HandleBaud(short  item) 

{ 

MenuHandle  menuHandle; 

long  numCharOut,  numCharOutr,  numCharln; 

int  serConfig, 

OSErr  resetErrln,  resetErrOut; 

char  inBufF[8]; 

SerStaRec  serialStatusOut; 


numCharOut=8L; 

menuHandle=GetMHandle(mBaud); 

CheckItem(menuHandle,gLastBaud, false); 

CheckItem(menuHandle,item,true); 

gLastBaud=item; 

switch(item) 

case  i300: 

FSWrite(gASerRefOut,  AnumCharOut,  "#000030C"); 
gserConfig=baud300+data8+stop  1 0+noParity ; 
break; 
case  i600; 

FSWrite(gASerRefOut,  AnumCharOut,  "#0000600"); 
gserConfig=baud600+data8+stop  1 0+noParity ; 
break; 
case  i  1 200 : 

FSWrite(gASerRefOut,  AnumCharOut,  "#0001200"); 
gserCor<fig=baud  1 200+data8+stop  1 0+noParity; 
break; 
case  i2400: 

FSWrite(gASerRefOut,  AnumCharOut,  "#0002400"); 
gserConfig=baud2400+data8+stop  1 0+noParity; 
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break; 
case  i4800: 

FSWrite(gASerRefOut,  AnumChaiOut,  *#0004800"); 
gserConf g=baud4800+data8+stop  1 0+noParity ; 
break; 
case  i9600: 

FSWrite(gASerRefOut,  &numCharOut,  *#0009600*); 
gserConfig=baud9600+data8+stopl  0+noParity; 
break; 

} 

SerStatus(gASerRefOut,&serialStatusOut); 

while  ((serialStatusOut.rdPend  !=  0)  |)  (serialStatusOut.wrPend  !=0» 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

FSRead(gASerRefln,  AnumCharOut,  AinBuff); 
resetErrOut=SerReset(gASerReflOut,gserConfig); 

resetErrIn=SerReset(gASerRefIn,gserConfig);  //  Set  the  protocal 

if  ((resetErrln  >  ■  •  T'rr)  j|  (resetErrOut  !=  noErr)) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pProblem  setting  the  serial  protocal."); 

} 


/* - •/ 

/* - HandleSignal - */ 

void  HandleSignal(short  item) 

Str255  periodData="\p!M52  "; 

Str255  numMaxData="\p!M63  "; 

Str255  windowData="\p!M74  *; 

char  hexChar; 

long  numCharOut,  numCharln; 

char  inbuffj 30] ,  outbuff[20],  addressBuf[10]; 

int  cr[l]  ={13}; 

int  radix,  hexDec; 

short  i; 

int  period,  numMax,  window; 

SerStaRec  serial  StatusOut; 


numCharOut=5L; 

FSWrite(gASerRefOut,  AnumCharOut,  "#PTR  "); 
SerGetBuf(gASerRefTn,AnumCharIn); 
while(numChar!n  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
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FSRead(gASerRefln,&numCharIn,&addressBuf)', 


switch(item) 

{ 

case  iPeriod: 

gPeriod=HandleDialog(kPeriodDialog); 

period=gPeriod; 

for  (i=0;i  <  kl6Bit;  i++) 

radi\=Power(kHexBase>k  1 6Bit- 1  -i); 
hexDec=period/radix; 
hexChar=DecIntToHexChar(hexDec); 
periodDataf  1  +i+periodData[0]]=hexChar; 
period=period-hexDec*radix; 


periodData[periodData{0]+k  1 6Bit+l  ]=cr[0]; 
periodData[0]=periodData[0]+k  1 6Bit+ 1 ; 


for  (i=0;i<periodData(0];i++) 

{ 

outbuff|i]=periodData[i+l); 

} 

numCharOut=periodDa  ta  [0] ; 

break; 
case  iNumMax: 

gNumMax=HandleDialog(kNumMaxDialog); 

numMax=gNumMax*2; 
for  (i=0;i  <  k8Bit;  i++) 

{  .  . 

radix=Power(kHexBase  Jc8Bit-l  -i); 

hexDec=numMax/radix; 
hexChar=DecIntToHexChar(hexDec); 
numMaxDatal  I  +i+numMaxData[OJ]=hexChar, 
numMax=numMax-hexDec*radix; 

numMaxData[numMaxData(0]+k8Bit+l]=cr[0]; 

numMaxData[0]=numMaxData[0J+k8Bit+l; 

for  (i=0;i<numMaxData[0];i++) 

{ 

outbufffi]=numMaxData[i+IJ; 

} 

numCharOut=numMaxData[0]; 
break; 
case  Window: 

gWindow»HandleDialog(kWindowDia!og); 

window»gWindow; 

for  (i=0;i  <  kl6Bit;  i++) 

radix*Po  werflcHexBaseJc  1 6Bit- 1  -i); 
hexDec*window/radix; 
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hexChar=Dec!ntToHexChar(hexDec); 
windowData[  1  +i+numMaxData[0]  ]=hexChar; 
window=window-hexDec*radix; 

} 

windowData[windowData[0]+k  1 6Bit+ 1  ]=cr[0] ; 
windowData[0]=windowData[0]+k  1 6Bit+ 1 ; 

for  (i=0;i<windowData[0];i++) 

{ 

outbuff[i]=windowData[i+l]; 

} 

numCharOut=windowDataIO]; 

break; 

} 

FSWrite(gASerRefOut,&numCharOut,&outbuff); 
while(l  ==  1) 

SerGetBuf(gASerRefln,&numCharIn); 

FSRead(gASerRefln,  &numCharIn,  &inbuff); 

if(inbuffInumCharIn-lL]  =  03)  break; 

} 


} 

/* 


- ♦/ 


/* - DecIntToHexChar - *f 

int  DecIntToHexChar(int  decimal) 

{ 

int  hexChar; 

if  ((decimal  >=  0)  &  (decimal  <  10)) 
hexChar=48+decimaI; 
if  ((decimal  >=  10)  &  (decimal  <  16)) 
hexChar=55+decimal; 

retum(hexChar); 

/• - - - */ 


/* - ConcatString - */ 

void  ConcatString(Str255  strl,  Str255  str2) 

{ 

short  i; 

for(i=str  1  [0]  ;i<str2(0]+str  1  [0]  ;i++) 

{ 

str  1  [i+ 1  ]=str2[i-str  1  [0]+ 1 ) ; 
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} 

strl[0]=i; 

} 

/♦ - */ 


/• - HandleDialog - 

unsigned  long  HandleDialog(int  dialogRes) 

{ 


WindowPtr 

DialogPtr 

Boolean 

Handle 

Handle 

short 

Rect 

long 

unsigned  long 


window; 

dialog; 

dialogDone; 

textltemHandle, 

okltemHandle; 

itemType,  itemHit; 

itemRect; 

itemNum; 

itemNumU; 


- */ 


window=FrontWindow(); 

dialog=GetNewDialog(dialogRes,nil,kMoveToFront); 

ShowWindow(dialog); 

SetPort(dialog); 

/*  SetDialogDefaultItem(dialog,  ok); 

SetDialogCancelItem(dialog,  cancel); 
SetDialogTracksCursor(diaIog,  true); 

*/ 


GetDItem(dialog,  iMessageText,  &itemType, 

AtextltemHandle,  AitemRect); 
GetDItem(dialog,  ok,  AiternType,  AokltemHandle, 

AitemRect); 

SelIText(dialog,  iMessageText,  kMinTextPosition,  kMaxTextPosition); 

dialogDone=false; 
while(  !  dialogDone) 

{ 

GetIText(textItemHandle,  AgltemText); 

ModalDialog(nil,  AitemHit); 

switch(itemHit) 

{ 

case  ok: 
case  cancel: 

dialogDone=true; 

break; 

} 

) 

DisposeDialog(dialog); 
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SelectWindow(window); 

SetPort(window); 


StringToNum(gItemText,  &itcmNum); 

itemNumU=itemNum; 

retum(itemNumU); 

} 

/* - */ 


/* - HandleKeyln - */ 

void  HandleKeyIn(char  theChar) 

{ 

int  bufferLength,  i; 

RgnHandle  gtempRgn; 

long  numCharOut,  numCharln; 

char  addressBuf[10]; 

gtempRgn  =  NewRgn(); 

switch(theChar) 

{ 

case  'W': 

gDataScan=false; 

SelectWindo\v(gTerminalWind); 

SctPort(gTerminaIWind); 

DrawString(*\pW"); 

ScrollDisplayO; 

DrawString("\p:'); 

break; 

case  TC': 

gDataScan=false; 

SelectWindow(gTerminalWind); 

SetPort(gTerminalWind); 

numCharOut=5L; 

FSWrite(gASerReft>ut,  AnumCharOut,  "#PTR  "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

} 

FSRead(gASerRef!n,&numCharIn,&addressBuO; 

bufferLength=TalkSailCPO; 

DisplayString(bufTerLength); 

gi=OL; 

break; 

case 

gDataScan=true; 

SelectWindow(gWetPaperWind); 

SetPort(gWetPaperWind); 
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for  (i=0;i  <  10;i-H-) 

{ 

ScrollDataScanO; 

} 

numCharOut=5L; 

FSWrite(gASerRefOut,  AnumCharOut,  "#PTR  "); 
SerGetBuf(gASerRefln,&numCharIn); 
while(numCharIn  <  9L) 

{ 

SeiGetBuf(gASerRefIn,&numCharIn); 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

bufferLength=TalkSail('0'); 

bufferLength=TalkSail(theChar); 

break; 

default: 

SelectWindow(gTenninalWind); 

SetPort(gTerminalWind); 

bufferLength=TalkSail(theChar); 

DispIayString(bufTerLength); 

break; 


} 


/• 


V 


/• - HandleDataln - 

unsigned  long  HandleDataIn(int  numDataPoints) 

{ 


int 

char 

unsigned 
unsigned  long 
Str255 

unsigned  long 

float 

Str255 


>.  j; 

max(8][4],  time{8][4]; 

timelnt[8],  maxlnt[8]; 

timeLong; 

timeOfMaxString; 

drawTime,  dtemp,  horizontalPosit; 

fraction; 

numpixel,horstring; 


•/ 


for  (j=O  j<gNumMax  j++) 

for  (i=0;i<4;i++) 

{ 

max[j][i]=gDataBuffer[8*j+4-i}; 

time[j]Ii]=gDataBufTer[8*j+8-iJ; 

> 


timelntlj]=0; 

maxIntU]=«0; 

for(i=0;i<4;i++) 
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timcInt[j]=timeIntlj]+HexCharToInt(tiine[j][i],i); 

maxInt(j]=maxInt[j]+HexCharToInt(max[j][i],i); 

} 

} 

for  (i=0;i  <  gNumMax;  i++) 

{ 

drawTime=(tinieInt[i]*(ghorizontalPixels-8lJL))/gPeriod; 

SetPort(gWetPaperWind); 
horizontalPosit=dra  wT  ime+kLeflMargin; 

PenNomalO; 

MoveTo(horizontalPosit,gDataRcwStart); 

Line(0,0); 

} 

ScrollDataScanO; 

timeLong=timeInt[0] ; 
retum(timeLong) ; 

} 


/• - HexCharToInt - */ 

unsigned  HexCharToInt(char  Bite.int  exponent) 

{ 

unsigned  value; 


if  ((Bite  >  47)  &  (Bite  <  58)) 

value=(Bite-48)*Power(kHexBase,exponent); 
if  ((Bite  >  64)  &  (Bite  <  71)) 

value=(Bite-55)*Power(kHexBase, exponent); 

retum(value); 


/* - V 

/* - -TalkSail - */ 

int  TalkSail(char  theChar) 

{ 

long  numCharOut,  numCharln,  startTime,maxTime; 

OSErr  serOutErr,  serlnErr; 

char  inBuff[bufferSize],DataBuffer[bufferSize], inChar; 

int  i,  start; 

SerStaRec  serialStatusIn,  serialStatusOut; 

Str255  startString; 


numCharOut=  1L; 


serOutErr=FSWrite(gASerRefOut,  &numCharOut,  AtheChar); 
if  (serOutErr  !=  noEn) 

{ 

SysBeep(10); 

DrawString("\pProbIem  sending  the  character  out."); 
ScrollDisplayO; 

DrawString("\p:’); 

} 

SerStatus(gASerRefOut,&serialStatusOut); 

while  ((serialStatusOut.rdPend  !=  0)  ||  (serialStatusOut.wrPend  !=0» 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

SerStatus(gASerRefIn,&serialStatusrn); 
while(serialStatusIn.rdPend  !=  0) 

SerStatus(gASerRefIn,&serialStatusIn); 

start=0; 

startTime=TickCountO; 
maxT  ime=startT  ime+20L; 
while(l  ==  1) 

{ 

SerGetBuf(gASerRefIn,&numChai  In); 
serInErr=FSRead(gASerRefIn,  AnumCharln,  AinBufT); 
if  (serlnErr  !=  noErr) 

{ 

SysBeep(lO); 

DrawString("\pProblem  receiving  characters."); 
ScrollDisplayO; 

DrawString("\p:"); 

} 

memmove(&gDataBuffer[  start], &inBuff/iumCharIn); 
start=start+LoWord(numCharIn); 

if(inBuff[numCharIn-lL]  =  03)  break; 
if((start  <  2)  &  (TickCountO  >  maxTime))  break; 

} 

retum(start); 

} 

/* - •/ 


/* - DisplayString - •/ 

void  DisplayString(int  numDataPoints) 

{ 

int  i; 

for  (i=0;i  <  numDataPoints  ;i++) 

{ 
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switch(gDataBuffer[i]) 

{ 

case  03: 

break; 

case  13: 

{ 

if  (gDataBuflfer(i+l]  =  10) 

{ 

ScrollDisplayO; 

»=i+l; 

} 

break; 

} 

case  10: 

{ 

if  (gDataBufTer[i+IJ  =  13) 

{ 

ScrollDisplayO; 

H+l; 

> 

break; 

} 


default: 

DrawChar(gDataBufFer[i]); 


/* - ScrollDisplay - */ 

void  ScrollDisplay(void) 

{ 

RgnHandle  tempRgn; 

WindowPtr  window; 


window  =  FrontWindowO; 
tempRgn  =  NewRgnO; 

ScrollRect(&window->portRect,  kHorizontalOffset, 
-kRowHeight,  tempRgn); 

DisposeRgn(tempRgn); 

MoveTo(kLeftMargin,  gRowStart); 

} 

/• - */ 


/• - ScrollDataScan - */ 

void  ScrollDataScan(void) 

{ 

RgnHandle  tempRgn; 
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WindowPtr 


window; 


window  =  FrontWindowO; 
tempRgn  =  NewRgnO; 

ScrollRect(&window->portRect,  kHorizontalOffset, 

-kDataScanHeight,  tempRgn); 

DisposeRgn(tempRgn); 

MoveTo(kLeftMargin,  gDataRowStart); 

} 

/. - */ 


/• - DoUpdate - */ 

void  DoUpdate(EventRecord  ’eventPtr) 

{ 

WindowPtr  window; 

window  =  (WindowPtr)eventPtr->message; 

BeginUpdate(window); 

//  put  some  update  info  in  here 
EndUpdate(window); 

} 

/. - V 


/* - Power - */ 

int  Power(int  base,  int  exponent) 

{ 

int  i,  p; 


P=l; 

for  (i=l  ;i  <=  exponent;++i) 
p=p*base; 
retum(p); 

} 

/» - •/ 


trackerflong  numExp) 

int 

>.j. 

int 

nextlteration,  noUpdate=0,  numlterations=0; 

long 

u,  index  1,  index2; 

double 

f,  Cs=1.5; 

double 

theta(kParameters]={0.0,l  000.0,-2500}; 

double 

xvar,  yvar,  tvar,  V[kNumMeas]; 

double 

term; 

double 

stopval=1.0,  epsilon=0.1,  epsilonc; 
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D[kParameters]{kParameters]; 
Dinv[kParameters][kParameters] ; 
dtheta[kParameters]={0.0,0.0,0.0}; 
dthetaSum[kParameters]={0.0,0.0,0.0}; 

Z0=0.0,  Zl; 
dl_x,  dl_y,  d_z,  dl; 
d2_x,  d2_y,  d2; 

g[kNumExp+l],  gllkNumExp+1]; 
dthetaVec; 
xl.x2.yl.y2; 
lamdal,  lamda2; 
feasl,  feas2,  feas3,  rhomax; 
nextlter=true; 

*e,  *a,  *b,  *c,  *lamda; 

•wtrue; 

•dwtrue; 

•wmeas; 

numstr,  thetaString; 
thestring; 

maxR=5000.0,  maxD=- 5000.0,  minD=-1.0; 

wtrue  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(wtrue  =  NULL) 

{ 

DrawStringOpCan't  allocate  memoiy  for  data  collection!!!'’); 

abortO; 

wmeas  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(wmeas  ==  NULL) 

{ 

DrawStringCXpCan’t  allocate  memory  for  data  collection!!!"); 
abortO, 

} 

dwtrue  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(dwtrue  ==  NULL) 

{ 

DrawString("\pCan’t  allocate  memoiy  for  data  collection!!!"); 

abortO; 

} 

e  =  caHoc(kNumExp*kNumMeas,sizeof(double)); 
if  (e  ==  NULL) 

{ 

DrawStringOpCan’t  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

a  =  caIloc(kNumExp*kNumMeas,sizeof(double)); 
if  (a  =  NULL) 

{ 

DrawStringOpCan’t  allocate  memory  for  data  collection!!!*); 


double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

Boolean 

double 

double 

double 

double 

Str255 

long 

double 
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abortO; 


} 

b  =  calloc(kNumExp*kParameters,sizeof(double)); 
if  (b  =  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

c  =  calloc(kNumExp,sizeof(double)); 
if  (c  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

lamda  =  calloc(kNumExp,sizeof(double)); 
if  (lamda  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 


f=1.0/sqrt(2.0); 

for(u=0;u<kNumExp;u++) 

{ 

index  1=3*  (u*kStep+numExp); 
if(index  1  >=  3*kStep*(kNumExp+l)) 

index  1  =index  1  -3  *kStep*(kNumExp+l ); 

index2=3*((u+kNumExp/2)*kStep+numExp); 
if(index2  >=  3*kStep*(kNumExp+l)) 

index2=index2-3  *kStep*(kNumExp+ 1 ); 


for(i=0;i<3;i++) 

wtrue[kNumMcas*u+i]=gw[  index  1  +i] ; 
wtrae[kNumMeas*u+i+3}=gw[index2+i]; 
wmeas[kNumMeas*u+i  j=gw[index  1  +i]; 
wmeas[kNumMeas*u+i+3]=gw[index2+iJ; 

} 


while(stopval  >  epsilon) 

{ 

numlterations-H-; 

for(i=0;i<kParameters;i++) 

{ 

dthetaSum[i]=0.0; 
for  (j=0  jc3;j++) 

D[il(j]=00; 

} 

Z0=0.0; 
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for(u=0;u<kNumExp;u++) 

{ 

for(i=0;i<kNumMeas;i-H-) 

{ 

c[6*u+i]=wtme[6*u+i]-wmeas[6*u-HJ; 

} 

dl_x=(wtrue[6*u]-theta[0])*(wtrue[6*u]-theta[0]); 
d  1  _y=(wtruc[6*u+ 1  ]-theta(  1  ])*(wtrue[6*u+ 1  ]-thetal  1  ]); 
d_z=theta[21*theta[2J; 
d  1  =sqrt(d  1  _x+d  1  _y+d_z); 

d2_x=(wtrue[6*u+3]-thcta{0])*(wtrue[6*u+3]-theta[0]); 
d2_y=(wtrue[6*u+4]-theta[  1  ])*(wtnie[6*u+4)-theta[  1  ]); 
d2=sqrt(d2_x+d2_y+d_z), 

g[u)=dl-d2-Cs*wtrue[6*u+2]+Cs*wtrue[6*u+5]; 

a[6*u+0)=  (wtrue(6*u+0]-thcta[01)/dl; 
a[6*u+l  J=  (wtrue{6*u+ 1  J-thetaf  I  ])/d ! ; 
a[6*u+2]=  -Cs; 

a[6*u+3]=  -(wtrue[6*u+3]-theta{0))/d2; 
a[6*u+4]=  -(wtrue[6*u+4]-theta[  1  J)/d2; 
a[6*u+5]=  Cs, 


b[3*u+0]=(wtnie[6*u+3]-theta[0))/d2-(wtrue[6*u+0]-theta[0])/dl; 
b[3*u+l  ]=(wtrue[6*u+4]-thet«l  l])/d2-(wtruc[6*u+l  ]-theta[  1  ])/dl ; 
b[3*u+2]=thetaI2)/dl-theta(2]/d2; 
for(i=0;i<3;i++) 

if(b[3*u+ij  =  0.0) 

b[3*u+i]=le-6; 


c[u]=0.0; 

for(j=0j<6j++) 

tertn=a[6*u+j]*gV(j]*a[6,u-^J; 

c[u]=c[u]+tenn; 

for(i=0;i<3;i++) 

{ 

for(j=0y<3J++) 

{ 

D[i]Ul=D[i]U]+(l/c[ul)*(b[3*u+i]*b[3*u+j]); 

} 

dthetaVec=0.0; 

for(i=0;i<6;i++) 

{ 

dthctaVcc=d(hctaVec+a{6*u+iJ*e[6*u+i); 

) 
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for(i“0;i<3;i++) 

< 

dthctaSum[i]=dthetaSum(i]+(dthetaVec-g[u])*b[3*u+i]/clu], 

} 

ZO=ZO+g[u]*g[u]/c[u]; 


x  1=D[  1  ][  1  ]-D[0][  1  j*D[  1  ][0]/D(0][0]; 
x2=D[l][2]-D[0](2]*D[  1  ][0]/D[0](0]; 
y  1=D[2J[1]-D[0][1]*D[2][0)/D{0](0]; 
y2=D[2][2]-D[0][2]*D[2][0]/D[0][0]; 


Dinv[21t2J=x  I/(x  1  *y  2-x2*y  1 ); 

Dinv[l][2]=-x2/(xl*y2-x2*y  1); 

Dinv[0][2]=-(D[0][l]*Dinv[l](2]+D[0][2]*Dinv[2][2))/D[0][0]; 


Dinv[2J[  1  ]=-yl/(x  1  *y2-x2*y  1 ); 
Dinv[l][l]=(1.0+x2*yl/(xl*y2-x2*yl))/xl; 

Dinv[0][  1  ]=-(D[0][  1  ]*Dinv[  1  ][  1  ]+D[0][2]  *Dinv[2}[  1  ])/D[0][0]; 

Dinv[2][0]=(xl/(xl*y2-x2*y  1))* 

(-D[2][0]/D[0][01+(D[  1  l(01*y  l>/(E>t0][0]*x  1)); 
Dinv[  I  ][0]=-(D[  1  ][0|/D[0][0]+x2*Dinv[2][0])/x  1 ; 

Dinv[0][0]=(l  ,0-(D[0][  1  ]*Dinv[  1  ][01+D[0][2)*Dmv[2][0]))/D[0][0]; 


for(i=0;i<kParameters,i++) 

{ 

dtheta[i]=0.0; 

for(j=0;j<kParameters,j++) 

{ 

dtheta  [  i  ]  =dthe  ta  [  i  ]  +Dinv  [  i]  [j  ]  *  dthe  ta  Sum[j  ] ; 

} 

} 

for(u=0,u<kNumExp;u-H-) 

{ 

lamda  1=0.0; 
for(i=0;i<3;i++> 

{ 

lamda  l=lamda  l+b{3*u+i]*dtheta[i]; 

} 

lamda2=0.0; 

for(i=0;i<6;i++) 

{ 

Iamda2=lamda2+a[6*u+i]*e[6*u+i]; 

} 

lamda[u]=(lamda  1  -lamda2+g[u])/c[u]-, 


for(i=0;i<6;i++) 

{ 

//  term=gV[i]*a[6*u+i]; 
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dwtrue[6*u+i]=-e[6*u+i]-lamda[u]*gV[i]*a[6*u+i], 

} 

} 

if(dtheta[0]  >=  0.0) 

feas  1  =(kMaxR-theta[0])/dtheta[0] ; 
if(dtheta[0]  <  0.0) 

feasl=(kMaxR+theta[0])/(-dtheta[0]); 

if(dtheta[l]  >=  0.0) 

feas2=(kMaxR-theta[  1  ])/dthc'. .[!]; 
if(dtheta[l]  <  0.0) 

feas2=(klviaxR+theta[  1  ])/(-dtheta[  1  ]); 

if(dtheti>[2]  >=  0.0) 

feas3=(kMinD-theta  [  2  ])/dtheta[  2  J ; 
lYd*heta[2]  <  0.0) 

feas3=(kMaxD-theta[2]Vdtheta{2]; 

rhomax=1.0; 
if(feas'  <  rhomax) 

rhomax  =  feasl; 
if(feas2  <  rhomax) 

rhomax  =  feas2; 
if(feas3  <  rhomax) 

rhomax=feas3; 

cpsilon=(gtheta[0]+0.001)/le6; 
if(epsilon  <  0) 

epsilon=-epsilon; 
cpsilonc=(gthetaI  1  J+0.00  l)/le6; 
if(epsilonc  <  0) 

epsilonc=-epsilonc; 
if(cpsilonc  <  epsilon) 

epsilon=epsilonc; 
epsilonc=(gtheta[2]-K).001)/le6; 
if(epsilonc  <  0) 

epsilonc=-epsi  lone ; 
if(epsilonc  <  epsilon) 

epsilon=epsilonc; 

nextlteration=0; 
while(nextIteration  =  0) 

{ 

Z  1=0.0; 

for(u=0;u<kNumExp;u-H-) 

{ 

dl_x=({wtrue[6*u]+Thomax*f*dwtrue[6*u)) 

-(gtheta[0]+rhomax*f,dtheta[0J))* 

((wtrue[6*u]+Thomax*f*dwtrue[6*ul) 

-{gthet4[0]+rhomax*f*dtheta[01)); 
d  1  _y*((wtrue(6*u+l  ]-Hhomax*  f*dwtrue[6*u+l  ]) 


-(gthetaf  1  ]+rhomax*f*dtheta(  1  ]))* 
^(wtrue[6*u+l]+rhomax*f*dwtrue[6*u+l]) 

-(gthetaf  1  ]+rhomax*f*dtheta[  1  ])); 

d_z=(gtheta[21+rhomax*f*dtheta[2])*(gtheta[2]+rhomax*f*dtheta[2]); 
d  1  =sqrt(d  1  _x+d  1  _y +d_z); 

d2_x=((wtrue[6*u+3]+rhomax*f*dwtrue[6*u+3]) 

-{gthetafO  ] +rhomax  *  f*  dthetafO]))  * 
((wtnie[6*u+3]+rhomax*f*dwtrue[6*u+3]> 
-(gtheta[0]+rhomax*  f*  dthetafO])); 
d2_y  =((wtrue  [6  *  u+4  ]  +rhomax*  f*  d  wtme  [6  *  u+4] ) 

-(gthetaf  1  ]+rhomax*f*dtheta[  I  ]))* 
((wtrue[6*u+4]+rhomax*f*dwtrue[6*u+4]) 

-(gthetaf  1  ]+rhomax*f*dtheta[  1  ])); 
d2=sqrt(d2_x+d2_y+d_z); 

gfu]=dl-d2 

-C  s*  ( wtrue  [6  *  u+2  ] +rhomax  *  f*  dwtrue  [6  *  u+2  ]) 
+Cs*(wtruef6*u+5]+rhomax*f*dwtnie[6*u+5]); 

Zl=Zl+g1(ul*gl(u]/c(ul; 

} 

if(noUpdate  >  5)  Z1=0.0; 
if(Zl  <  ZO) 

{ 

noUpdate=0; 

nextIteration=l; 

for(i=0;i<3;i++) 

{ 

thetafi]=thetafil+rhomax*f*dtheta[i]; 

gPosition(ij=gPositionfil+theta[i]; 

) 

for(u=0;u<kNumExp,u-H-) 

{ 

for(i=0;i<6;i++) 

wtrue[6*u+i]=wtnie{6*u+i] 

+thomax*f*dwtruef6*u+i], 

} 

} 

else 

rhomax=rhomax/2.0; 

noUpdate++; 

} 

MoveTo(50,150); 

thestring=thetafO]; 

NumToString(thestring,&numstr); 

DrawString(numstr); 

DrawString("\p  .  ’); 
thestring=theta{  1); 

NumT  oString(thestring,&numstr); 
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DrawString(numstr); 

DrawString("\p  :  "); 
thestring=theta[2]; 
NumToString(thestring,&numstr); 
DrawString(numstr); 
for(i=0;i<10;i++)  ScrollDataScanQi 


} 


if(numIterations  >  50) 
stopval=0.0; 

else 

{ 

if(dtheta[0]  <  0) 

stopval=-dtheta[0]; 

else 

stopval=dtheta{  0] ; 

} 


if(numExp  <  (kNumExp+l)*kStep-l) 
gnumExp=gnumExp+ 1 L; 

else 

gnumExp=0L; 


free(wtrue); 

free(wmeas); 

free(dwtrue); 

free(e); 

free(a); 

free(b); 

free(c); 

free(lamda); 
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